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Abstract 

Over the last two and a half years we have been demonstrating a new method- 
ology for the design of rotorcraft flight control systems (FCS) to meet handling 
qualities requirements. This method is based on multicriterion optimization as im- 
plemented in the optimization package CONSOL-OPTCAD (C-O). This package 
has been developed at the Institute for Systems Research (ISR) at the University 
of Maryland at College Park. This design methodology has been applied to the 
design of a FCS for the UH-60A helicopter in hover having the ADOCS control 
structure. The controller parameters have been optimized to meet the ADS-33C 
specifications. Furthermore, using this approach, an optimal (minimum control 
energy) controller has been obtained and trade-oflF studies have been performed. 
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Introduction 


1.1 Design of rotorcraft flight control systems to meet handling qual- 
ities requirements 

In a classical SISO control system design process, the practical design specifications are 
often replaced by standard control design specifications such as bandwidth, overshoot, 
etc. The main reason for using these standard specifications is that some (or all) of 
them can be satisfied using classical techniques such as root locus, Bode, etc. Of course, 
using standard specifications, instead of the original ones, leads to an approximate 
design. Moreover, these design techniques are limited to one or two (competing) 
specifications. It is difficult, if not impossible to use them for the design of MIMO 
control systems such as a modern rotorcraft FCS. Note that for MIMO systems some of 
the standard SISO specifications are not defined or have only “conservative” meaning 
(e.g., gain and phase margins). 

In modern rotorcraft FCS design for handling qualities some MIMO control design 
methods have recently been used. These methods include optimal techniques such as 
LQR [1], ^ 2/^00 [2,3], parametric optimization [4,5], etc., and other MIMO design 
techniques such as eigenstructure assignment [6], QFT [7], Nyquist array [8], etc. (see 
[9] for partial review). The main disadvantage of these MIMO techniques is that 
using precisely the theoretical design procedure it is either impossible to meet all the 
design requirements or many design iterations are required. Therefore many ad hoc 
design methods, based on theoretical MIMO techniques, are also used. Using those 
techniques (e.g., [10]) the design process is usually made in two phases. First we solve 
the theoretical problem (e.g., LQR), then we tune the design to meet the handling 
qualities requirements using simulation and/or test flight results (see for example [11] 
and [3]). 

In fact there are no direct design methods for meeting handling qualities require- 
ments. In this research we propose to use multicriterion parametric optimization as 
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the basis for a new direct design methodology. 


1.2 Research objectives 

The main objectives of this research are: 

• Development of a rotorcraft FCS design technique based on multicriterion opti- 
mization. This method allows the designer to design “directly from the specs” 
to meet any (nonstandard) design specifications, such as handling qualities. 

• Demonstration of this method by finding a set of FCS parameters such that the 
UH-60A in hover meets the LEVEL 1 performance requirements of the ADS-33C 
[12] (a feasible solution). 

• Further demonstration of this method by meeting the ADS-33C level 1 specifi- 
cations with minimum actuator “energy” (an optimal solution). 

• Demonstration of the use of this method and the above criterion to perform 
trade-off studies. 

1.3 Organization 

The report is organized into seven sections. In Section 2 the general multicriterion- 
optimization-based design process is presented followed by a brief description of each 
of its components. The optimization package CONSOL-OPTCAD is introduced in 
Section 3. The design setup for the UH-60A in hover is given in Section 4. In Section 5 
the nominal (LEVEL 1) design is presented including design considerations and results. 
In Section 6 two trade-off cases, performance/specification and performance/hardware, 
are studied. In addition the robustness of the optimal design is examined. Finally, 
some concluding remarks and some suggestions for future work are given in Section 7 

This report has two appendices. Appendix A is a listing of all the computer code 
used in the design process. A tutorial example is given in Appendix B. 
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2 Multicriterion-Optimization-Based Design Methodol- 


ogy 

2.1 Introduction 

Real design problems are usually multifaceted. There is usually a variety of constraints 
on the solution as well as a group of, often conflicting, objectives. It is extremely dif- 
ficult, if not impossible, to translate such a collection of specifications into a single 
objective functional as is required by most optimal control methods. As systems be- 
come more complex and their required performance levels increase it becomes difficult, 
if not impossible, to use classical methods to design satisfactory controllers. 

The multicriterion-optimization-based design methodology is based on a combina- 
tion of computer-based parametric optimization and human control designers. The 
idea is to use the computer to compute performance measures and find controller 
parameters that optimize them. The human designer decides whether the computer- 
generated design is adequate, and if it is not, changes the problem posed to the com- 
puter so as to drive the computer-generated solution in a better direction. 

The role of the computer is a multicriterion parametric optimization. The human 
designer’s first step is to translate the constraints and objectives of the design into a 
collection of smooth scalar functions of the (vector of) design parameters, say f x ( x ) 
where i = 1, 2, . . . , n and x is an m- vector of design parameters. The computer then 
tries to optimize (maximize) 

max / (x) = max < min a x fi (x) > (2.1) 

xeC x£C [i=l,2 v ..,n J 

where C is the set of allowable x’s (defined by some of the constraints) and c^, i — 
1, 2, . . . , n is a set of real weights chosen by the designer. 

To understand why the design problem is posed this way, consider the following 
example. 
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Let /i(x) and fi{x) of Figure 2.1-a be two performance measures of a control 
system, where x is the scalar design (controller) parameter. Let f(x) — F (/i(x), / 2 (x)) 
be the optimization (maximization) objective (i.e., max f(x)). Suppose we define 
f(x) = max fi(x) (Figure 2.1-b). Then / 2 (x) has no effect on the solution to the 

t=l,2 

optimization problem. In fact then, x\ is the only possible “optimal” solution. One 
may try also taking / 2 (x) into account by defining a weighted objective function / (x) = 
aifi(x), aj G 1R (Figure 2.1-c). Then only xi or X 2 can be “selected”. In order 
to have more design degrees-of-freedom, let f(x) = min aj/j(x). Then by choosing 
aj’s the designer can change the “optimal” solution to be any x e [xi,X 2 ] , see Figure 
2.1-d. 

This simple example emphasizes the importance of the proper choice of F(-,-) 

(the “design specifications”). Such a “max/min” (maxminaj/i(x)) or “min/max” 

(min max ai/i(x)) optimization problem is the basis for the design methodology pre- 
x i 

sented in this report. In fact, given n performance measures fi(x), i = 1,2, 
where x € IR m is the vector of the design parameters (d.p.’s), the design can be 
accomplished by performing the following three steps 

Step 1 - Choose n a^s. 

Step 2 - Optimize f(x) over x. (2-2) 

Step 3 - Check the design. If it is good, stop. Else, go to Step 1. 

Note that we do not know yet how to implement the above design procedure. In 
fact this is only a conceptual procedure, a more practical procedure is given below. 
Note also that we do not even know how to define and compute the performance 
measures, the fi(xYs. Usually obtaining “good” /i(:r)’s is a very complicated problem. 
This task is a part of the preliminary stage which has to be completed prior to the 
implementation of the above procedure. 

The overall design process is schematically presented in Figure 2.2. It is assumed 
that the physical system and the design specs are given, as is typically true in rotorcraft 
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Figure 2.2: Schematic description of a multicriterion-optimization-based design pro- 













control design. The preliminary part of the design process (modeling, translation of 
the design requirements into mathematical functions, and development of a simulation 
program) is marked by thick (double line) arrows. The iterative parts of the process are 
the computerized optimization (thin solid arrows) and the human designer interrupts 
(thin dashed arrows). 

The multicriterion-optimization-based design process has two main parts. First, 
the designer has to prepare the design setup. This noninteractive part of the process 
includes: modeling (mathematical representation of the system) and translation of the 
design specifications into nice mathematical functions. 

In the interactive part of the process, the optimization is done automatically by the 
optimization/simulation package (see [13] and Section 3 below). The designer has to 
continuously monitor the results by using the design evaluation tools, then if he finds 
it necessary he can interrupt the process. The specific action that the designer may 
take depends on several factors. Because the designer usually interrupts the process 
through the designer/optimization interface, a major factor is the properties of the 
specific optimization package. Some suggestions are given in Section 3.4 below. 

A detailed description of the design process and its components is given in the 
following sections. 

2.2 Preparing the design setup 

In preparing the design setup, much care should be taken because this stage affects 
the whole design process. We especially have to consider the practical trade-off be- 
tween “accuracy” and “time”. For higher accuracy we would like to choose the most 
comprehensive model, to write a sophisticated simulation code, to use a small step size 
for optimization, etc. However this choice leads to a very “time consuming” design 
process. This problem becomes critical because of the presence of a human designer 
in the design process. 

Given the system and the design specifications, the following preparations have to 
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be made prior to the implementation of the iterative procedure. 


2.2.1 Modeling the system 

Very complicated mathematical models are often required in order to obtain accurate 
simulation of real control systems. The first design task is to find the simplest model 
which still captures the main dynamic characteristics of the system. Choosing simpler 
models may spoil the design. On the other hand increasing the size and complexity, 
may lead to a long and annoying design process. In most cases finding the “optimal” 
model is not a simple task. 

In this stage issues such as linear model vs. nonlinear model, continuous-time 
model vs. discrete-time model, small model vs. large model, etc., have to be studied 
carefully. 

Remark 2.1 Usually the model also has to represent implementation limitations such 
as actuator saturation , controller size , sampling rate , etc. Therefore sometimes (e.g., 
actuator saturation) a linearized model can not be used. 

2.2.2 Translating the design requirements into “nice” mathematical func- 
tions 

Modern design requirements such as “handling qualities” are very difficult to translate 
into smooth mathematical functions. In some cases these functions are defined in terms 
of numerical evaluation of the solution to some differential equations (“simulation”). 
In other cases even more mathematical manipulations (on the simulation results) are 
required. 

Using optimization special care should be taken with these translations. For most 
optimization techniques, these mathematical functions have to be “smooth” with re- 
spect to the design parameters (at least continuously differentiable). Even standard 
performance measures, which are used in conventional design techniques, are often not 
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useful for optimization. For example, spectral characteristics such as eigenvalues, are 
usually not differentiable with respect to the control law parameters. 

Because most of these functions have no analytical expression, it is difficult and 
in most cases even impossible to check their smoothness. Therefore in some cases 
we may use nonsmooth functions for optimization. Usually these functions are not 
smooth only at a finite number of points in the parameter space. Thus practically 
they may work. However using such functions for optimization may cause the design 
process to get stuck. 

2.2.3 Defining the optimization criteria 

This is the second part of the translation of the design specifications. The optimization 
criteria are based on both the performance translations and some properties of the 
optimization package. For example using CONSOL-OPTCAD [13] with a vector of 
time (or frequency) dependent performance measure, the optimization criterion may 
be given as a functional constraint or objective. 

2.3 The computerized tools used in the design process 

Three computerized tools are used in the design process: optimization, simulation, 
and design evaluation (see the dotted box in Figure 2.2). These tools interact with 
each other, thus it is essential to choose or develop the proper software packages and 
interfaces. 

2.3.1 Optimization 

The role of the optimization in the design process is defined in Step 2 of the conceptual 
procedure (2.2). Namely, finding a set of design parameters x* such that the /i(x*)’s 
satisfy the criteria. 

The particular implementation of the optimization “block” in the design pro- 
cedure depends on the choice of the optimization package. In this research the 
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CONSOL-OPTCAD optimization package is used. This package has a built-in inter- 
face with some common simulation languages including MATLAB. For more details 
on CONSOL-OPTCAD see Section 3 below. 

2.3.2 Simulation 

Given the system model, the definition for /*(■), and the design parameters x , the 
simulation generates / 2 (#)’s . Moreover the simulation also provides most of the infor- 
mation required for the design evaluation. 

In order to obtain more information required for the optimization, such as gradi- 
ents, the simulation is often used iteratively. Therefore it is important to choose the 
proper simulation language and to write an efficient simulation code. Other proper- 
ties of the simulation language (package) should also be taken into account such as: 
standard interface (to be used with the optimization package), “user friendly”, tech- 
nically supported, etc. In fact, for these reasons we chose the MATLAB package as 
the simulation package for this research. 

Remark 2.2 Using other simulation packages, or even writing a special simulation 
program using a standard computer language (e.g., C) may lead to a “faster” simula- 
tion. However, because these solutions do not have the nice advantages of MATLAB, 
the total time which may be spent using these alternatives may be larger. 

2.3.3 Design Evaluation 

“Design evaluation” stands for all the computerized tools which help the human de- 
signer to obtain the right decisions during the design process. In some cases no ad- 
ditional tools are required, e.g., when the standard outputs of the simulation and 
optimization packages provide all the necessary information. However, in most real- 
system-design cases some special tools are required. In particular this is true when 
the design is made to meet requirements such as the handling qualities. 
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In this research we have developed such a specific evaluation “toolbox”. This 
toolbox performs an on-line graphical analysis of the system performance which allows 
the human designer to make on-line decisions. For more details see Appendix A. 

2.4 The human designer 

The human designer is definitely the most important component of the design proce- 
dure. His or her role in the design process is given by Step 1 and Step 3 of the concep- 
tual algorithm (2.2). However contrary to the computerized tools, it is generally not 
clear what the designer has to do at any design iteration. In fact the decisions that 
the designer takes are in many cases based on his intuition and experience. Therefore, 
at least for the time being, the human designer can not be replaced by a computer. 

The experience gained in using this methodology in this research and in other re- 
lated projects may be used as the basis of new rules and guidelines for future designers. 

3 The Optimization Package: CONSOL-OPTCAD 

3.1 Introduction to CONSOL-OPTCAD 

In an attempt to better represent real world design problems, CONSOL-OPTCAD (C- 
O) allows for three qualitatively different types of design specifications. An objective 
is a specification of a quantity that should be optimized (minimized or maximized). 
Typically, multiple competing objectives are present. A hard constraint is a speci- 
fication of a quantity that must achieve a specified threshold. A soft constraint is a 
specification of a quantity that should achieve, or at least approach, a specified thresh- 
old, i.e., should be optimized as long as this threshold is not achieved. Soft constraints 
can be thought of as intermediate between objectives and hard constraints. 

Choosing the proper scale factor for each design specification may be a difficult 
task. Therefore instead of using a single scale factor (weight), each objective and soft 
constraint (value) is scaled by C-0 using “good' and “6ad” values according to the 
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formula 



where having any value achieve its corresponding good (bad) value should provide the 
same level of satisfaction (dissatisfaction) to the designer. This uniform scaling rule 
helps the designer in choosing the proper weights (if good = 0 then a* of (2.2) is ^). 
Note that using practical values for the good and bad scaling parameters may cause 
too large differences between the sensitivity of the various d.p.’s. Therefore, in order 
to make the parameter space more “uniform”, C-0 also allows the designer to scale 
each d.p. separately. In addition to the above design specifications, it is also possible 
to put hard bounds on the d.p.’s. 

In order to have a better understanding of these quantities, consider the following 
simple example. Suppose we have to design a cheap audio amplifier, with 4 °^ < a 
and maximum input power « b. The design (amplifier) parameters have some bounds 
(e.g., negative feedback gain for stability). The corresponding optimization problem 
has the following setup 


objective 

= dollar cost 

min 

hard const. 

noise 

signal 

< a 

soft const. 

= input power 

< b 

hard bound 

= f.b. gain 

<0. 


C-0 divides the optimization process into 3 phases. In Phase 1, if 4°^ > a for every 
choice of parameters, then it is impossible to satisfy the hard constraint unless we allow 
C-0 to increase the input power and the cost. Then C-0 minimizes the amplifier input 
power (Phase 2) and its cost (Phase 3). 

C-0 uses FSQP (Feasible Sequential Quadratic Programing) to solve the following 
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general optimization problem 


min objf(x) Vi 

subject to: softf(x) <0 Vy ^ 

hard* k {x) <0 Vfc 
boundf(x) < 0 VZ 

where obj* , so/tj, hard)?, and bound f are the scaled values of objectives, soft con- 
straints, hard constraints and hard bounds, respectively. Problem (3.3) is then as- 
signed three different meanings, corresponding to three different phases, according to 
feasibility or infeasibility of x with respect to hard and soft constraints. 

Phase 1 (hard feasibility problem): Not all hard constraints are satisfied. (3.3) 
takes the form 

min max hardl(x) 

x * (3.4) 

subject to: bound* {x) <0 VZ. 

Phase 2 (soft feasibility problem): All hard constraints axe satisfied. Not all 
(scaled) objectives and soft constraints are nonpositive. (3.3) takes the form 

min max {objf (x), soft* (x)} 

subject to: hard s k (x) <0 Vfc (3-5) 

bound* (x) <0 VZ. 

Phase 3 (optimization problem): All hard constraints are satisfied and all (scaled) 
objectives and soft constraints are nonpositive. (3.3) takes the form 


min max objf (.r) 
subject to: softj(x) <0 Vj 

hard k (x) <0 VA: 

bound* (x) <0 VZ. 
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C-0 has a PCOMB (performance “comb”) pseudo-graphical output display which 
gives very useful information. An example of a PCOMB display is shown in figure 3.1 
below. 

3.2 Using C-O to meet the handling qualities requirements (ADS- 
33C) 

The design of a flight control system to meet the ADS-33C (Aeronautical Design Stan- 
dard) [12] requirements can be obtained as a solution to the soft feasibility problem 
(3.5). That is, all the ADS-33C requirements are translated into C-0 hard and soft 
constraints (no objective). The design goal is achieved when C-0 successfully com- 
pletes Phase 2. 

Theoretically, if the feasible set is nonempty , and all the performance functions 
are globally smooth and convex with respect to the d.p.’s, then starting with any 
(infeasible) point, the C-0 solution will converge to a feasible solution. However 
practically, none of the above three conditions (existence, smoothness, and convexity) 
is guaranteed. We can not change the feasibility of the problem (and also its convexity), 
but we can improve the smoothness of the performance functions by using proper 
translations and/or smooth approximations. In fact, part of the art is finding ways to 
describe the desired system performance mathematically so that the C-0 solution will 
converge to a “good” controller. 

3.3 Using C-O to find an optimal controller 

If there is more than one feasible solution, it is natural to search for the optimal 
solution. First we have to choose the optimization objective (if it is not given a 
priori). A natural choice for the objective function can be any scalar function of the 
design parameters which has no constraints, that it would be nice to have it small (or 
large), such as the control energy. Multiple objective functions may be taken. The 
choice of objective functions has to be done with the same care (smoothness!) as for 
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Figure 3.1: An example of the C-0 PCOMB output display. In Phase 1, Cl (hard 
cons.) is minimized. In Phase 2, C2 (soft cons.) is m i n i m ized. In Phase 3, 02 
(objective) is maximized. Double dashed lines - soft constraints and objectives. Single 
dashed lines - hard constraints. * - scaled value € (—1,2). > - scaled value > 2 (too 
bad). < - scaled value < — 1 (very good). For more details on the PCOMB display 
see [13]. 
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the problem constraints. Note that the natural objective function may not always be 
smooth (see for example Figure 5.7). 

Theoretically, if the objective functions are smooth and convex with respect to the 
d.p.’s, then starting with any (feasible) point, the C-O solution will converge to the 
unique optimal solution. Practically, starting with any arbitrary feasible point, if the 
C-0 solution converges, then it converges to a local minimum. 

3.4 The C-O/designer interface 

As we already mentioned, this is usually the only interface between the human designer 
and the optimization process. The ability of the designer to guide and control the whole 
process depends on the design degrees-of-freedom that C-O provides. The human 
designer’s actions also depend on the simulation and optimization results. It is hard 
to give a recipe which covers all the possible situations. The following guidelines are 
given as general advice for the designer: 

• Make the constraint and objective functions as smooth as possible (a smooth 
approximation is better then a more accurate nonsmooth approximation). 

• Freeze all the unnecessary d.p.’s. It saves time. 

• Use all possible C-O information (“p comb”, “print”, “trace”, “active”, etc.). Also 
use the other design evaluation tools (e.g., time and frequency response, perfor- 
mance map, etc.). 

• If C-O gets stuck, “shake” the optimization. 

Again there is no general solution for this situation. However the following list 
may be used if the process gets stuck (termination of the computer run, the computer 
starts to work very slowly, etc.). 

If C-O gets stuck during Phase 2: 

• Look for competing specs. 
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• Change constraint weights (“good”, “bad” values). 

• Keep the scaled objective functions below the scaled constraint functions. 

• Change the nominal variations of some d.p.’s. 

• Perfom one or two dimensional analysis (see Section 6 for example). 

• Change manually the value of some d.p.’s. 

• Improve the smoothness of constraint functions (use alternative definitions, or 
approximations) . 

• Change controller structure (e.g., add dynamics). 

If C-O has trouble switching from Phase 2 to Phase 3: 

Near the boundaries C-0 may work slowly. Change the variation step (“scale”), or 
if it is possible (very close to the boundaries), “right-shift” or “left-shift” the “good” 
value (i.e., spoil the good value so that C-0 “jumps” to Phase 3). 

If C-O gets stuck during Phase 3: 

• Make all objective functions negative for all feasible d.p.’s (e.g., for minimization 
less than their good values). This is required by C-O [13]. 

• Put small weights on the relevant constraints which might oppose the minimiza- 
tion process (e.g., min. actuator ’’energy” vs. quickness). 

• Look for competing objectives (no competing objectives in our design problem). 

• Change objective weights (“good”, “bad” values). 

• Change the nominal variations of some d.p.’s. 

• Perfom one or two dimensional analysis. 

• Change manually the values of some d.p.’s. 
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• Improve the smoothness of objective functions (use alternative definitions, or 
approximations) . 

Remark 3.1 When C-0 finds a local minimum it gives a CONGRATULATIONS 
message. Using objective functions such as control energy, “push” the solution (some 
performance measures) to the boundaries of the feasible set (LEVEL 1). Then C-0 
may start to move slowly . Usually you do not have to wait for this message , just use 
the design evaluation tools to decide when to stop the optimization process. 

4 Design Setup 

4.1 Introduction 

The UH-60A (Black-Hawk) helicopter in hover was chosen as a benchmark example 
for this research. Its flight control system has an ACAH (Attitude Command Atti- 
tude Hold) response type. The design specifications are given in the ADS-33C [12], 
Paragraph 3.3 - hover and low speed. The design specification affects both parts of 
the design setup (i.e., system modeling and specification translation). 

In addition to the optimization package (C-O) and the simulation package (MAT- 
LAB), the design setup contains: 

• A main C-0 PDF adocs and some “include” spec files (see [13] and Appendix 
A). These files contain all the ADS-33C information required by C-O. 

• Initialization ( init.m ) and simulation ( simu.m ) M-files, containing the MATLAB 
simulation code required to evaluate all the ADS-33C performance measures (see 
Appendix A). 

• The design evaluation M-files (see Appendix A). 

The background and other considerations used to develop the above setup are 
summarized in the following. 
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4.2 Modeling the UH-60A in hover 


The comprehensive rotorcraft aerodynamic model “UMGenhel” [14] requires too much 
computer time for one simulation run to be useful for the purposes of this research. 
Thus we wrote a simplified model which can be used by the optimization package (C- 
O). The simplified model represents the helicopter linear dynamics and aerodynamics, 
as well as the most important system nonlinearities (i.e., actuator saturation). The 
specific representation of the helicopter in hover has been modified several times in 
order to obtain the system performance measures as well as to satisfy some computa- 
tional limitations. 

The final configuration, shown in Figure 4.1, includes the following parts: 

(i) Linearized and reduced (UMGenhel) dynamic model P(s) - The bare 
airframe model has a total of 11 states, 9 states for the 6 DOF fuselage dy- 
namics and 2 states for the main rotor flapping motion (using model reduction 
techniques, the effect of higher dynamics is also included in the model). The 
dynamic model is given by the following state equation 


x = Ax + Bu a + Wd g 
y - Cx 


(4.1) 


where x = («, v, w,p, q, r, <f> , 0, ip) J , which stands for the longitudinal velocity ( u ), 
lateral velocity ( v ), vertical velocity (w), roll rate (p), pitch rate ( q ), yaw rate 
(r), roll angle ((f)), pitch angle (0), and yaw angle (ip). The state equation (4.1) 
has two inputs, u a = (u$, u^, u^,u c ) T representing respectively the longitudinal, 
lateral, tail rotor collective, and main rotor collective actuator displacements 
(control). The second input d g = (de, d<p, d^) T represents respectively the pitch, 
roll, and yaw (wind gust) disturbances. The output y, required to evaluate all the 
desired specifications, is in fact all of the state vector excluding the longitudinal 
(u) and lateral velocities (v). 
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Figure 4.1: Model of the UH-60A. 
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An important component of the initial task of this project was to verify the 
(linearized) helicopter model. First this model was compared with the full UM- 
Genhel model (39 states) [14], to verify the use of only 11 states. Then it was 
compared with a simplified 6 DOF model (9 states) (used in [15]), to verify its 
main characteristics. In addition, using “real” ADOCS parameters, its closed- 
loop response was qualitatively checked. 

(ii) Actuator Model - The swashplate actuators are modeled using standard satu- 
ration functions for displacement and rate limits and a 1 st order approximation 
for the actuator dynamics (see Figure 4.1). Note that the displacement satura- 
tion is implemented on the actuator command as is standard [16]. 

(Hi) Delay D(s) - Pure delay (e~ T5 ) represents an overall (r sec.) channel delay 
including: computation delays, A/D and D/A delays, unmodeled dynamics etc. 

( iv ) ADOCS control law - H is a constant gain, output feedback matrix. F(s) is a 
decentralized feedforward dynamic controller obtained from the model following 
concept [17], based on a command model dynamics M(s) and on a 1 st or 2 nd 
order approximation for the helicopter dynamics P a (s), see Figure 4.1. Note that 
if P a (s) = P(s) then the resultant closed- loop transfer function is M(s). The 
overall closed-loop system is controlled by the pilot using four input commands 
S = (8 $i 8< h 8 if ,6 e ) T representing respectively the longitudinal, lateral, tail rotor 
collective, and main rotor collective cockpit commands. 

In order to calculate efficiently all the desired performance measures, this model 
has two different versions. There is a continuous-time linear model, for small amplitude 
performance, where the actuator model is a simple 1 st order model (no saturation) 
and the delay D(s) is a 2 nd order Pade approximation. There is also a discrete-time 
nonlinear model, for large amplitude performance, where all the continuous time parts 
(i.e., P(s) and F(s)) are replaced by suitable ZOH equivalents, and the saturation 
functions are implemented directly. The nonlinear simulation is obtained by solving 
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the difference equations recursively. For more details see the M- files, init.m , simu.m , 
and drsc.m in Appendix A. 

4.3 The design specifications and their mathematical translations 

The following five specifications were identified as those that are essential to meet the 
ADS-33C [12]. These five requirements are naturally divided into two groups. Spec’s 
1, 2, and 5 relate to small-amplitude responses and can be checked using linear models. 
The remainder are related to moderate-amplitude responses and must be checked by 
nonlinear simulation. 

4.3.1 Spec 1: Small Amplitude Changes, Short Term Response to Control 
Inputs 

This modern frequency based criterion (bandwidth/phase-delay) replaces the tra- 
ditional specifications which used limits based on time-delay and rise-time. The 
bandwidth/phase-delay criterion emphasizes features directly related to closure of the 
piloted loop, and it is a better metric than rise- time for the prediction of handling 
qualities for small-amplitude precision tracking tasks. It is clear that pilots are also 
sensitive to the shape of the phase curve at frequencies beyond the bandwidth fre- 
quency. This shape is characterized by the phase-delay parameter [16]. Thus, the level 
regions for the short-term response requirement are defined in the bandwidth/phase- 
delay plane as shown in Figure 4.2-d. Actually, for small phase-delay systems this is 
a “pure bandwidth” criterion. Above a certain value of phase-delay (about 0.2 sec) 
it becomes a trade-off between bandwidth and phase-delay (i.e., the pilot can tolerate 
higher phase-delay but then, in order to achieve the same performance level, he needs 
higher bandwidth). 

Bandwidth and phase-delay are measured from a frequency response (Bode) plot 
of angular attitude response to cockpit controller input. Bandwidth and phase-delay, 
as defined in the specification [12], Paragraphs 3.3.2. 1 (Pitch, Roll) 3.3.5. 1 (Yaw), are 
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phase [deg] phase [deg] 


a. Bw=2.332 rad/sec; Pd=0.0802 sec; D=0 



c. Bw=0.4337 rad/sec; Pd=0.2144 sec; D=0. 1475 



b. Bw=2 rad/sec; Pd=0.2664 sec; D=0.01 99 



d. Spec 1 plane 



Figure 4.2: Spec 1: Bandwidth vs. Phase-delay (a-c) Bode phase plot, bandwidth and 
phase-delay of three examples, (d) their D meassures in the Spec 1 plane. 
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referenced to the helicopter with all augmentation loops closed. Thus, they can not 
be simply calculated from the closed-loop design parameters. Usually, two bandwidth 
frequencies are measured: the frequency for 6 db gain margin and the 

frequency for 45° of phase margin (w B w phase ). For AC AH response types w B iv phMe 
is taken, since the nature of ACAH is such that the pilot does not have to close the 
attitude loop for stabilization purposes, so the gain margin problems are less apparent. 
Phase-delay is defined so that it represents all of the contributions to phase less than 
-180°, see Figure 4.2-c, and is based on the observation that the phase curve tends 
to be linear in the neighborhood of the crossover frequency. 

In order to meet the LEVEL 1 (also true for other levels) requirement a two 
dimensional geometrical measure D (normalized quadratic distance) is defined, such 
that minimizing this measure implies better performance. The computation of this 
measure is done in three steps. First, the graphical level curve is converted into an 
analytic smooth function using a polynomial curve fitting algorithm. In order to 
achieve a univalent function the level curve is represented as ljbw = f( T d), i-e, the 
bandwidth frequency is a function of the phase-delay, which is a nondecreasing C°° 
function, Figure 4.2-d (the dotted curve). This calculation is done only once in the 
initialization routine (for more details see init.m in Appendix A). The other two steps 
are executed in each iteration. First, the bandwidth and phase-delay are computed, 
based on the definitions of Figure 4.2-c, using an efficient search algorithm. Second, 
the D measure is calculated as the minimum normalized quadratic distance from the 
current {u)BW,Td) point to the level curve. Moreover, measure D is calculated only 
for points which are not in the LEVEL 1 region (i.e., they are to the left of the 
dotted curve in Figure 4.2-d), and it is set to zero for any ( u)BW,fd ) point within the 
LEVEL 1 region. Because D(u>BW,Td) is quadratic, using the above definition keeps 
it differentiable even on the boundary of the LEVEL 1 set (i.e., ubw = f( r d)), and 
gives an identical weight for any point in the desired set (LEVEL 1 region). The 
computation of D uses the fact that the level curve is a nondecreasing function, so it 
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eliminates the need to evaluate the function ujqw — fi^d) at each ujbw = fi^d) (for 
more details see d-bw-pd.m in Appendix A). 

Remark 4.1 The use of polynomial curve fitting is limited for the given data points. 
That is, the approximation c oqw — f( r d) holds only for r, d E [0,0.4] [12]. Therefore 
hard constraints are used to guarantee that < 0.4. 

4.3.2 Spec 2: Small Amplitude Changes, Mid-Term Response to Control 
Inputs 

This requirement is, in general, the complementary part of the short term response re- 
quirements of Spec 1. The short term criterion emphasizes features related to the high 
frequency modes, whereas the mid-term influences mainly the low frequency modes. 
Although, because of the particular definitions of both criteria, it is unavoidable that 
this requirement overlaps the short-term one. The mid-term requirement is specified 
for two different pilot operation modes: “Fully Attended Operations” - where all of 
the helicopter tasks can be accomplished with full pilot attention to aircraft control 
(e.g., other crew members handle the non-control tasks), and “Divided Attention Op- 
erations” - where the pilot should be able to relinquish control of the helicopter for 
short periods of time without encountering significant excursions. Consideration of 
divided attention (as done in this research) ensures that, at least practically, any flight 
control system which meets this requirement is stable. In fact a helicopter which meets 
the fully attended requirement can have unstable mid-term response (as with many 
present-day helicopters). For more information see [12], Paragraphs 3. 3. 2. 2 (Pitch, 
Roll) 3. 3. 5. 2 (Yaw). 

Remark 4.2 Although it is not an ADS-33C requirement , an asymptotic stability 
hard constraint is used ( i.e 3?{A m (A — BH)} < 0 ). This constraint is required for 
numerical reasons. 
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At the beginning we tried to use the damping ratio parameter £ for this require- 
ment. This parameter, which is well defined for second-order systems, can be in- 
terpreted in several different ways for higher order systems. Unfortunately, most of 
these interpretations lead to numerical algorithms which are either significant time 
consumers, or are not smooth enough, or both. For example, computing £ as the 
logarithmic decrement of the two first peaks of the system step response is very time 
consuming. On the other hand, using eigenvalues, in order to find £ as the ratio 
between the imaginary and the real part of the 2 nd order approximated model, is 
generally, not a smooth calculation. The computer time problem becomes critical 
because this algorithm has to be executed in a multi-iteration optimization process. 
The smoothness problem is sometimes even more critical because it may cause failure 
of the optimization process. 

During this work we have also examined several approximations for ( based on 
model reduction techniques, system identification, 2 nd and 3 rd order approximations, 
etc. Unfortunately, these methods have been found to be either not accurate enough, 
or too complicated, or both. Furthermore the original ADS-33C specification has a few 
disadvantages. First, theoretically it also contains the undesired “long term” response 
(phugoid modes). Second, using only the original definition does not always prevent 
PIO (Pilot Induced Oscillations). 

Therefore instead of using the original “damping ratio” (or “pole location”) crite- 
rion we have used a classical stability margin criterion, gain margin ( GM ) > 6 db and 
phase margin (PM) > 45°. Note that these classical stability margins are actually 
SISO specifications. Therefore, for each channel, we have used the “broken-loop” of 
figure 4.3 as the channel SISO approximation. 

Remark 4.3 The Spec 2 results presented in the sequel have been obtained using an 
incorrect broken-loop scheme, where only the position loop was broken. This sometimes 
has led to an oscillatory closed loop characteristic (see for example the roll channel step 
response in Figure 5.9). Using this incorrect scheme does not affect the main results 
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Figure 4.3: “Broken loop” scheme for stability margins. 

and the conclusions presented in this report. Furthermore the updated computer code 
contains the correct scheme (see simu.m in Appendix A and the tutorial example of 
Appendix B). 

4.3.3 Spec 3: Moderate-Amplitude Attitude Changes (Attitude Quick- 
ness) 

Frequency domain-based criteria (e.g., bandwidth) fail in the presence of strong non- 
linearities such as saturation. Therefore, in order to check the helicopter performance 
during large maneuvers we have to define alternative criteria. Recall that for a 2 nd 
order linear system with a step input the following “quickness” ratio 

qukkness = peak rate 2) 

steady-state displacement 

is directly related to the system bandwidth. This ratio is also a good approximation 
for the system bandwidth for high order systems [16]. Using this criterion instead 
of one of the classical linear measures of bandwidth allows the specification to make 
the required bandwidth a decreasing function of the size of the maneuver, as shown 
in Figure 4.4. For nonlinear systems, especially with saturation nonlinearities, this 
concession is essential (i.e, it is unreasonable to require the same “bandwidth” for all 
input heights). In these cases it is not correct to interpret this ratio as a bandwidth, 
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desired position (input) [deg] 

Figure 4.4: Spec 3: Attitude quickness. 

but it is better interpreted as a measure of agility (i.e., “quickness” ratio). For more 
information see [16], Paragraphs 3.3.3 (Pitch, Roll) 3.3.6 (Yaw). 

The calculation of the quickness ratio (4.2) is very simple. The max(-) operator is 
used over the sampled rate vector. It is then normalized by the input height. Note 
that using the max(-) operator in this case does not destroy smoothness because we 
try to maximize the quickness ratio and the combination max/max is smooth. This 
test theoretically has to be checked for an infinite number of inputs. Practically we 
check it for each channel for only three different angles (1,2,3) as shown in Figure 4.4 
(for more details see simu.m in Appendix A). 

By definition, for nonlinear systems the quickness specification depends on the 
input signal. In [12] the input signal is not explicitly specified. It is required that the 
pilot perform agressive (displacement) manuevers. This may be interpreted as step 
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Limited-rate step input for pitch and roll Limited-rate pulse input for yaw 




Figure 4.5: Input signals for Spec 3. 

inputs for the pitch and roll channels, and a pulse input for the yaw channel (the 
yaw channel has an integrator in its desired model M(s) [18]). Therefore, taking into 
account the rate limitations for the cockpit joystick and pedal [3], we have used the 
rate-limited inputs of Figure 4.5. 

4.3.4 Spec 4: Interaxis coupling 

Helicopter dynamics are naturally interaxis coupled. The following requirements re- 
late to the two common helicopter interaxis couplings. These are the cross-coupling 
between pitch and roll (i.e., pitch/roll and roll/pitch), and yaw (rate) due to collec- 
tive. These couplings are caused mostly by aerodynamic rotor moments and by the 
nonsymmetric tail moments. Both couplings would adversely affect the pilot’s ability 
to complete some high maneuver tasks. One of the most important design objectives 
is to minimize these couplings. 

The decoupling requirement is mostly significant for high maneuver responses. 
Thus, it is checked only for large amplitude “step” responses (The coupling measures 
are relative measures. Hence, in the case of linear systems small input amplitudes 
can be used as well). The natural measure is used for the cross coupling between 
pitch and roll (i.e., the ratio of peak off-axis response to desired response, 9 p k/<f>des , 
and (f> p k/0des )• To avoid use of non different able functions such as max(-) and abs(-), 
suitable upper and lower limits are defined to bound the response over the relevant 
time interval (i.e., C-0 functional constraints [13]). 
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pitch/roll roll/pitch ^ aw 



time [sec] r3/lw(3)l [deg/ft] time [sec] 

Figure 4.6: Spec 4: Interaxis coupling. 


For the yaw-to-collective decoupling requirement a much more involved criterion is 
required. This criterion is designed to meet the pilot’s needs during aggressive tasks. 
This criterion is a measure of not only the magnitude, but also the shape of the yaw 
rate response to a step collective stick input. The shape of the yaw rate is taken into 
account by measuring the peak yaw rate r 1 and the value of yaw rate after 3 seconds. 
In case there is no peak in the time interval [0,3] the yaw rate at 1 second r( 1) is 
taken instead ([12], Paragraph 3.3.9). In addition to the above requirement, it is also 
required that the maximum oscillation amplitude, following a step collective change 
be below a certain limit. From accumulated experience this limit has to have units 
[12], (i.e., it is not relative as in the pitch-roll case). 

All the information required for the coupling specs is taken from the largest input 
simulation of the quickness test (for more details see simu.m in Appendix A). An 
example for Spec 4 performance measures is given in Figure 4.6. 

4.3.5 Spec 5: Wind-gust rejection 

The model-following concept allows the designer to increase the I/O bandwidth (the- 
oretically unlimited) by changing the parameters of the desired model M(s) only. 
Actually, this is the major advantage of using a model-following control, because in 
most cases the designer can not achieve the desired bandwidth due to closed-loop 
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0.2 



Spec 5 plane 



time [sec] 


Figure 4.8: Spec 5: Wind-gust rejection - required envelope 

stability limitations (e.g., limited state feedback gains). However, this approach has 
some disadvantages. One of them is that the disturbance rejection requirement (sys- 
tem “stiffness”) is no longer directly related to the overall system bandwidth (i.e., we 
can have a high-bandwidth, low-stiffness system). Therefore, the original wind-gust 
rejection criterion ([12], Paragraph 3.2.6) is not suitable for the ADOCS configura- 
tion. A new requirement was defined by using an approximate gust model, where the 
gust peak value is chosen to fit the disturbance input point (recall from (4.1) that the 
wind-gust is applied directly to the helicopter state equations). The wind-gust input 
wave form is shown in Figure 4.7, the detailed definition of the new requirement is 
presented in [19]. 

The wind-gust rejection criterion is a two parameter criterion. Following precisely 
the requirements for the ACAH response type [12] leads to a pulse-input-settling-time 
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criterion. The first parameter, settling-time, t 5 (a) is defined by the condition that the 
absolute value of the response |y(£)| < a V i > £ 5 (a), where a is 10% of the response 
peak value. The second parameter is the peak value itself. Practically, settling-time 
is obtained using a discrete-time search algorithm, which may cause t s (a) not to be 
smooth with respect to the design parameters. Moreover, in order to obtain the 
peak value we have to use the max(-) operator, and since the optimization algorithm 
tries to minimize this peak it may cause some smoothness difficulties. To avoid this 
possibility it is highly recommended that one uses functional constraints. Therefore, 
the ACAH response type requirement was slightly changed such that the angular 
position following a wind-gust input should lie between the two curves of Figure 4.8. 

Remark 4.4 Theoretically the wind-gust rejection requirement should be checked us- 
ing the time history data from the nonlinear simulation. Because this test has to be 
simulated for jO seconds it becomes the biggest time consumer of the simulation. In 
order to save time , this test is implemented using a linear simulation . The linear sim- 
ulation holds as far as the actuators rates and displacements do not hit the saturation 
level. This (practically) holds when the system is stable (no counter example has been 
found throughout this research). Proper “flags” have been added to the simulation to 
ensure that the linearity assumption holds. 

4.4 The design parameters 

An important component of the design setup is the choice of the proper design param- 
eters (d.p.’s). The considerations for this choice are a mixture of classical control and 
optimization considerations. From the optimization point of view we would like to use 
as few d.p.’s as possible in order to save “running time”. The control considerations, 
based on the classical ADOCS design of [15], are summarized in the following. 

• For stability and closed-loop properties a position/rate (“PD”) feedback is used. 

Therefore the rate (K q , K p , K r ) and the position (Kq, K#, K^) feedback gains 
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are used as the optimization d.p.’s. 

• Recall from Section 2.2.1 that the feedforward controller F(s) consists of two 
parts. There is the “open-loop inverse” part which “cancels” part of the heli- 
copter dynamics. This part consists of the following \ st order approximation of 
P{s), P a (s) = diag(p s (s),p^(s),p v ,(s)), with 


Pe{s) = 

M s ) = 

PA S ) = 


_Ms» 

“I* 


(4.3) 


We want to keep the “dynamic cancellation” properties of the feedforwaed con- 
troller. Therefore the above approximate inverse parameters are fixed. 

• The second part of the (model following) feedforward controller is the desired 
model M(s) = diag (M^(s) 7 M^(s), M^(s)), with 


"♦(<) = <4 ' 4) 

Note that the desired model is not an ADS-33C requirement. Therefore we can 
free olq^ol^ and as the optimization d.p.’s. 


5 The nominal design 

5.1 Introduction 

For the nominal design we consider performance LEVEL 1 for all MTEs (Mission Task 
Elements) excluding target acquisition and tracking for UCE (Usable Cue Environ- 
ment) 2 and 3. For detailed definitions see [12], Paragraph 3.3 - hover and low speed. 
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The ADOCS controllers [17], [15] were chosen as the initial controllers. 

The design was completed in two steps. First we solved the feasibility problem 
(with no objective). Then we added an objective function and we found the optimal 
controller. 

The starting design controller (initial guess) was chosen as the final ADOCS design 
of [18]. The performance map of this design is shown in Figure 5.1. Although this 
design has been tuned by both simulations and flight tests, 8 out of the 25 ADS-33C 
requirements are not satisfied. 

5.2 Nominal design with the ADOCS control structure 

The ADOCS flight control law is based on a decentralized SISO design. Using this con- 
cept, the only way to reduce the system coupling level is by using high feedback gains 
[15], [20]. Usually, high gains imply poor robustness (low stability margins). Therefore 
using the ADOCS structure with the multicriterion-optimization-based design process 
leads to “competing specs”. That is, trying to satisfy one design specification (Spec 
4) cause other(s) (Spec 2) to fail. Competing specs slow the design process and may 
cause the process to get stuck (even for smooth constraint functions). 

In the first attempt, we tried to solve the feasibility problem or, at least, to find 
the “best” (infeasible) solution without changing the ADOCS structure. After many 
design iterations (C-0 iterations and human designer interrupts) we concluded that it 
is impossible to simultaneously satisfy all the ADS-33C requirements using the ADOCS 
control structure. In the “best” design, as shown in Figure 5.2 only 3 performance 
measures are not satisfied. 

Remark 5.1 There is no definition for the “best” infeasible design (the best feasible 
design is the optimal one). However using engineering intuition and experience, it 
is possible to choose such a design. Moreover one may use C-0 information and/or 
other design measures to quantitatively order the infeasible solutions. 
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Figure 5.1: Performance map for the final ADOCS design; All 5 specs are shown in 12 
sub-figures. Dashed line - LEVEL 1 / LEVEL 2 boundary. Dotted line - LEVEL 2 / 
LEVEL 3 boundary. Specs are numbered 1, 2, . . . , 25. A - pitch, y - roll, O - yaw, 
* - not in the desired level. For more details see specs.m in Appendix A . 
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Figure 5.2: Best design using the ADOCS structure; A - pitch, y - roll, O - yaw, * - 
not in the desired level. 
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Remark 5.2 It is difficult to prove that there is no feasible ADOCS controller. That 
is, there may be such a feasible controller which can be found after many design iter- 
ations. However then we can not consider it to be a practical solution. Furthermore, 
the same conclusion (“LEVEL 1 performance can not be achieved using ADOCS”) 
was also obtained in [21 J. 


5.3 A feasible controller for the nominal design using an improved 
ADOCS control structure 

Two different techniques were studied in order to improve the results of Figure 5.2. Re- 
call that not any classical structure can be used as a good structure for multicriterion- 
optimization-based design. We were especially looking for a structure which required 
only a few additional d.p.’s. 

In the first (SISO) technique we tried to keep the decentralized control structure of 
ADOCS and to add dynamic compensation to each channel. For example, we applied 


C(s) = 


s z as + w c 


s + aw c 


(5.1) 


to the roll and pitch channels, where 2 , a and w c are additional design parameters. 

Using all six additional d.p.’s as free, C-0 drives, 2 0, a — > 1, i.e., the compensator 

(5.1) is canceled. On the other hand freezing all/some of these d.p.’s, leads to new 

competing specs (e.g., Spec 4 vs. Spec 5). 

In the second (MIMO) technique we tried to improve the decoupling performance 

of the controller by adding crossfeed compensation. In fact, in order to save d.p.’s we 

used only crossfeed gains. The implementation of the improved ADOCS control law 

1 k $/4 0 0 


is shown in Figure 5.3, where K c j = 


K t 


M* 


1 


0 0 
1 K 


rl>fc 


0 0 

0 0 0 1 

This very simple and cheap solution, has only 3 additional d.p.’s. Using this 


consists of static gains. 


controller the helicopter performance is improved substantially as shown in Figure 5.4. 
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disturbances 



Figure 5.3: An improved (ADOCS + crossfeed) control structure. 


Furthermore, although the additional d.p.’s make the C-0 iteration a little longer, the 
overall design process converges faster (no competing specs). 

Parameter changes for a “background run” of ~ 100 C-0 iterations (i.e., C-0 ran 
100 iterations using fixed weights and step size without designer interrupts) are shown 
in Figure 5.5. 

5.4 The optimal design 

The feasible design shown in Figure 5.4 is not unique. Changing some optimization 
parameters such as: initial guess, step size, etc., leads to other feasible solutions. In 
order to find the best (optimal) solution, we first have to define the design objective. 

In this research the design objective is to minimize the helicopter actuators energy. 
However, using the simple actuator model of Figure 4.1 allows us to compute only 
rates and displacements of the control actuators. In order to compute the actuator 
energy a more detailed model is required ( E — J Q ( rate x load)dt). Therefore, in 
order to save running time, we used the RMS actuator rates as an approximation for 
the RMS actuator power ( E oc RMS power). 

Using such an objective function, we expected the C-0 solution to converge to some 
boundaries of the feasible set (LEVEL 1 curves). Choosing the feasible controller of 
Figure 5.4 as the starting point for this design, C-0 chose this solution as the optimal 
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r [deg/sec] ^ max(r)/Step(Y) $ Phase delay [sec] 


Spec 1 : BW and PD Spec 2 : Stability margins Spec 3 : Quickness P Spec 3 : Quickness R 



Bandwidth [rad/sec] GM [db] Step(P) [deg] Step(R) [deg] 

D = 1.1, 1.2, 1.4 [rad/sec] Rrms = 6.8, 8.3, 4.6 [in/sec] Zeta = 0.23 at 3.4 [rad/sec] 


Spec 3 : Quickness Y Spec 4 : Coupling P/R Spec 4 : Coupling R/P Spec 4 : Coupling Y/C a 



Step(Y) [deg] time [sec] time [sec] r3/lw(3)l [deg/ft] 



Figure 5.4: A feasible controller using the ADOCS structure with crossfeed gains; A 
- pitch, v ' roll, ^ ■ yaw, * - not in the desired level. 
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Pitch 


Position FB gains Rate FB gains FF poles Position CF gains 




Figure 5.5: Parameter changes for a background run of « 100 C-0 iteration. Vertical 
axes - parameter values. Horizontal axes - iteration number. 
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Phase-delay [sec] 


Spec 1 




Bandwidth [rad/sec] 


Spec 3 3.34 




[rad/sec] 


Figure 5.6: Defining the feasible set for a#. dashed line is the current value a# and 
the dash-dotted line is the minimum a which is 3.34 in this example, for achieving 
level 1 performance 


one after only one iteration. In order to understand why this happened, we performed 
a local, one-dimensional analysis (see Section 2) as described in the following example: 

• We identified a $ as the only parameter which (locally) affects the quickness ratio 
of the roll channel (see “Spec 3: Quickness R” in Figure 5.4). 


• We defined the feasible set (line segment) for a <p as shown in Figure 5.6. 

• We plotted the roll quickness ratio as a function of a $ (Figure 5.7-a) for values 
including the current value (dashed line) and the boundary line (dash-dotted) of 
the feasible set. 


• The other three plots (b-d) of Figure 5.7 are for alternative objective functions. 

From Figure 5.7-a, we concluded that at the starting point in the d.p.’s space the 
objective function is “flat” (at least in one direction). Therefore C-0 did not move 
from this point (the same is true for the yaw channel). Note that for the pitch channel 
the solution is already on the LEVEL 1 boundary of Spec 1 (Figure 5.7). Thus it is 
not possible to reduce the pitch channel quickness ratio. 

Of course we can solve this problem (at least for the roll channel) using one of 
the alternative objective functions (c or d of Figure 5.7). However these measures 
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Roll quickness Roll quickness 


(a) (b) 




(c) 


(d) 




Figure 5.7: In all subplots: Horizontal axes - a $ [rad/sec], vertical axes - Roll quickness 
[1/sec], dashed lines - current a,p, dash-dotted lines - minimum feasible a^. (a) and 
(c) use the RMS actuator rate as the objective function, (b) and (d) use the RMS 
actuator stroke as the objective function, (a) and (b) consider the saturation of the 
actuator, while (c) and (d) do not. 
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r [deg/sec] max(r)/Step(Y) $ Phase delay [sec] 


Spec 1 : BW and PD 



0 5 

BandWidth [rad/sec] 

d= 1.1, 1.2, 1.4 [rad/sec] 


Spec 3 : Quickness Y 



Step(Y) [deg] 


Spec 2 : Stability margins 



GM [db] 


Rrms = 6.8, 4.7, 2.7 [in/sec] 


Spec 4 : Coupling P/R 



time [sec] 


Spec 3 : Quickness P Spec 3 : Quickness R 



Step(P) [deg] Step(R) [deg] 

Zeta = 0.23 at 3.4 [rad/sec] 

Spec 4 : Coupling R/P Spec 4 : Coupling Y/C a 



time [sec] r3/lw(3)l [deg/ft] 


-10 


4 : Coupling Y/C b Spec 5 : Wind-Gust P Spec 5 : Wind-Gust R Spec 5 : Wind-Gust Y 



time [sec] time [sec] time [sec] time [sec] 


Figure 5.8: The optimal (nominal) controller; A - pitch, y - roll, ^ - y aw > * “ not * n 
the desired level. 

may not be good a approximation for the actuator energy. A better solution is to 
“shake” the optimization using the ideas suggested in Section 3.4. In fact in this case 
we have manually set a $ = 5. This made C-0 converge to the LEVEL 1 boundaries 
as expected. The optimal performance map is shown in Figure 5.8. 

Remark 5.3 Using linear models, the cross-over frequency can be used as a good 
measure for the control energy. Then closed-loop parameters which affect the cross- 
over frequency ( i.e ., feedback gains), also affect the control energy. However, using the 
nonlinear model of Figure 4- 1 the saturation effect is dominant over the linear effects. 
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Pitch 


Roll 


Yaw 



Figure 5.9: Attitude change for the nominal optimal design. Horizontal axes - time 
[0-5 sec]. Vertical axes - attitude [deg]. Dashedl+0.75 lines - desired attitude [deg]. 

Therefore minimizing the cross-over frequency does not necessary lead to minimum 
actuator energy. Moreover from Figure 5.8 we conclude that the feedback gains are 
already on the LEVEL 1 boundaries (pitch <=>> Spec 1 , roll and yaw & Spec 4)- Thus 
they can not be further reduced. 

The attitude change for the nominal optimal design is shown in Figure 5.9. Re- 
call that using an incorrect broken-loop scheme led to oscillations in the roll channel 
response (see Remark 4.3). 
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6 Trade-off and robustness studies 


6.1 Introduction 

In this section we used the proposed design methodology to perform some trade-off 
studies. We checked the changes in the performance of the helicopter as some of the 
parameters change, while maintaining optimality. 

Two main trade-off studies are presented: 

• Performance/specifications - Going from the nominal optimal design (LEVEL 
1 ) to higher performance levels. 

• Performance /hardware - Changing some of the helicopter (actuators) param- 
eters. 


In order to make these trade-off studies quantitatively, a trade-off criterion is re- 
quired. A natural choice for this criterion is the optimization objective (actuator RMS 
rate). In fact we used the following normalized measure 


def actuator RMS rate 

actuator effort = 7 — - — — € 

actuator rate limit 


[ 0 , 1 ]. 


( 6 . 1 ) 


In addition to the trade-off studies we tested the robustness of the FCS design to 
perturbations in hover flight conditions. 


6.2 Performance to specification 

In this set of trade-off studies we tried to “push” the helicopter optimal performance 
as high as possible. That is, we tried to drive the nominal optimal design (LEVEL 1) 
to higher performance levels. As the design target (the highest level) we have chosen 
LEVEL 1 for “target acquisition and tracking” ([12], Paragraph 3.3). This level is 
marked as “LEVEL 1+1” in Table 6.1 (note that LEVEL 1+1 ± LEVEL 2). Using 
this notation allows us to quantify the intermediate levels between LEVEL 1 and 
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Phase delay [sec] 


MTE 

UCE 

Attention 

Design level 

target acquisition and tracking 

- 

- 

“Level 1+1” 


> 1 

- 

“Level 1” 

all others 

- 

divided 



1 

full 

not considered 


Table 6.1: ADS-33C design levels > 1 for hover. 
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Figure 6.1: Definition of levels > 1. LEVEL 1+# where # = a/b. 


LEVEL 1+1 as shown in Figure 6.1. Recall from [12] that only Spec 1 (for roll and 
yaw channels) and Spec 3 (for all channels) are changed. In the first step, using only 
a few C-0 iterations, we achieved the design LEVEL 1+0.5 of Figure 6.2. Note that 
the new dashed-dotted line indicates the boundaries of LEVEL 1+0.5 (for Spec 1 and 
Spec 3). However in the second step, when we tried to achieve the LEVEL 1+0.75 
C-0 got stuck in Phase 2 (see Figure 6.3). 

Using the list of Section 2 we performed a one-dimensional analysis along the cty 
axis of the d.p.’s space (all other d.p.’s are frozen). The quickness ratios of the three 
points of Spec 3 for the yaw channel, as a function of a are shown in Figure 6.4 
where the dotted line indicates the minimum required quickness ratio (the spec line) . 
The feasible set for a ^ is the intersection of the three line segments for which the 
quickness ratios of Figure 6.4 are above the spec line. Therefore the feasible set for 
LEVEL 1+0.75 is empty (the quickness ratio of the second point in Figure 6.4 is below 
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r [deg/sec] max(r)/Step(Y) $ Phase delay [sec] 


Spec 1 : BW and PD 



Bandwidth [rad/sec] 

3 = 1.1, 1.1, 1.4 [rad/sec] 


Spec 3 : Quickness Y 



Step(Y) [deg] 


Spec 2 : Stability margins 



GM [db] 

Rrms = 6.9, 7.1 , 5.4 [in/sec] 


Spec 4 : Coupling P/R 



time [sec] 


Spec 3 : Quickness P 



Step(P) [deg] 


Zeta = 0.23 at 3.5 [rad/sec] 


Spec 4 : Coupling R/P 
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Step(R) [deg] 


Spec 4 : Coupling Y/C a 



r3/lw{3)l [deg/ft] 



time [sec] time [sec] time [sec] time [sec] 


Figure 6.2: Optimal design for LEVEL 1+0.5; A - pitch, V - roll, ' yaw, * - not in 
the desired level. 
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r [deg/sec] max(r)/Step(Y) $ Phase delay [sec] 


Spec 1 : BW and PD Spec 2 : Stability margins Spec 3 : Quickness P Spec 3 : Quickness R 



Bandwidth [rad/sec] GM [db] Step(P) [deg] Step(R) [deg] 

3 = 1.1, 1.2, 1.3 [rad/sec] Rrms = 8.5, 8.9, 5.2 [in/sec] Zeta = 0.22 at 3.6 [rad/sec] 


Spec 3 : Quickness Y Spec 4 : Coupling P/R Spec 4 : Coupling R/P Spec 4 : Coupling Y/C a 



Step(Y) [deg] time [sec] time [sec] r3/lw(3)l [deg/ft] 


4 : Coupling Y/C b Spec 5 : Wind-Gust P Spec 5 : Wind-Gust R Spec 5 : Wind-Gust Y 



time [sec] time [sec] time [sec] time [sec] 


Figure 6.3: Final design for LEVEL 1+0.75; A - pitch, y - roll, ^ - yaw, * - not in 
the desired level. 
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quickness [1/sec] 


10 deg. 35 deg. 60 deg. 



[rad/sec] 


Figure 6.4: Yaw quickness ratios as function of Dashed lines - Spec 3 boundaries 
of Level 1+0.75. 

the spec line for all a ^). 

Reducing the specification level (spec line), we found that the maximum # is 0.65. 
In Figure 6.6 we can see the actuator effort as a function of # for all three channels. 
For the nominal design (# = 0) all actuators have about the same effort (20 - 30%). 
However increasing # (the required performance level) causes the effort of the tail rotor 
actuator (yaw) to increase while that of the main rotor actuators remain (almost) the 
same. That is, high level helicopter performance in hover is limited by the performance 
(size ?) of the tail rotor actuator. 

The change of the d.p.’s as a function of # is shown in Figure 6.5. Note that 
C-O increases the feedforward poles a<p and a ^ to achieve the quickness requirement. 
The crossfeed gain Kq/^ is increased to compensate for the corresponding increase in 
pitch-to-roll coupling. 
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nominal limit 
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v 


1 _ 1 
TS+l jS + 1 

Figure 6.7: Definitions of the limits factor /z and the time-constant factor v. 


6.3 Performance to actuator limits 

The actuator trade-off parameters are the rate and stroke limits and the time-constant. 
The corresponding factors fi G [0.5, 2] (for limits) and v G [0.5, 2] (for time-constant) 
are defined in Figure 6.7. Note that each one of these parameters was changed simul- 
taneously for all three channels. 

The design for /z G [0.75,2] is (almost) the same as for the nominal design (see for 
example Figure 6.8 for n = 2). However trying to achieve LEVEL 1 performance with 
/z = 0.5 C-0 got stuck. Again we performed a one-dimensional analysis along the 
axis for three values of /z, 0.5, 0.625, and 0.75 as shown in Figure 6.9. We saw that, 
for fi = 0.5 and fi = 0.625, the feasible set of is empty (the quickness ratios for 
the third point are below the spec line). We also found that n = 0.65 is the minimum 
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r [deg/sec] max(r)/Step(Y) $ Phase delay [sec] 


Spec 1 : BW and PD 



Bandwidth [rad/sec] 

D = 1.1, 1.2, 1.4 [rad/sec] 


Spec 2 : Stability margins 



GM [db] 

Rrms = 2.9, 2.2, 1 .6 [in/sec] 


Spec 3 : Quickness V Spec 4 : Coupling P/R 



Step(Y) [deg] 


time [sec] 


Spec 3 : Quickness P Spec 3 : Quickness R 



Step(P) [deg] Step(R) [deg] 


Zeta = 0.23 at 3.4 [rad/sec] 


Spec 4 : Coupling R/P Spec 4 : Coupling V/C a 



time [sec] r3/lw(3)l [deg/ft] 



Figure 6.8: Nominal design for = 2; A - pitch, v - roll, O - yaw, * - not in the 
desired level. 

admissible limit factor. The performance map for this case is shown in Figure 6.10. 

From Figure 6.11 it can be seen that the actuator RMS rates change very little as 
fj, increases. This makes the actuator effort decrease approximately as l//i. Parameter 
changes as function of /i are shown in Figure 6.12. Note that generally rate saturation 
improves the effective “damping ratio” of the system. That is, increasing ^ reduces 
the effective damping ratio. In order to compensate for this loss of damping, C-0 
increases the rate gains (especially K p ) as /i increases. 
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actuator limits 



Figure 6.9: Plot of the roll quickness as a function of for different actuator limits. 
Horizontal axes - [rad/sec]. Vertical axes - quickness [1/sec]. Dashed lines - a# of 
the last iteration. Dotted lines - spec. 
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Spec 1 : BW and PD Spec 2 : Stability margins Spec 3 : Quickness P Spec 3 : Quickness R 



Bandwidth [rad/sec] GM [db] Step(P) [deg] Step(R) [deg] 


Wco = 1 .1 , 1 .2, 1 .4 [rad/sec] Rrms = 2.2, 1 .9, 1 .4 [in/sec] Zeta = 0.23 at 3.4 [rad/sec] 

Spec 3 : Quickness Y Spec 4 : Coupling P/R Spec 4 : Coupling R/P Spec 4 : Coupling Y/C a 



Step(Y) [deg] time [sec] time [sec] r3/lw(3) I [deg/ft] 


Spec 4 : Coupling Y/C b Spec 5 : Wind-Gust P Spec 5 : Wind-Gust R Spec 5 : Wind-Gust Y 



time [sec] time [sec] time [sec] time [sec] 


Figure 6.10: Nominal design for = 0.65; A - pitch, y - roll, O - yaw, * - not in the 
desired level. 



actuator limits [%] actuator limits [%] 

Figure 6.11: Actuator effort as a function of (x. 
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(a) (b) 




(c) 


(d) 




a [rad/sec] 


Figure 6.13: (a) and (b) consider the saturation, while (c) and (d) do not. (a) and 
(c) use the RMS autuator rate as the objective function, (b) and (d) use the RMS 
actuator stroke as the objective function, o - nominal design. * - optimal design. Solid 
line - 50% time constant. Dashed line - 65%. Dash-dotted line - 100%. 


6.4 Performance to actuator time- constants 

In the second performance/hardware trade-off study, we first checked “slower” actu- 
ators (i.e., v E (1,2]). The helicopter optimal performance for v E (1,1.75] does not 
change much. However LEVEL 1 performance for v — 2 is difficult to achieve (design 
requires many human/C-0 design iterations). 

Apparently “faster” actuators should give better results. However checking v = 
0.5, C-0 moved the nominal yaw quickness solution (performance) from (above) the 
boundaries of the feasible set (LEVEL 1). Performing a one-dimensional analysis along 
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50% 65% 75% 



Figure 6.14: Pitch actuator rate as a function of v 



v [%| 

Figure 6.15: Actuator effort as a function of v 

the cty axis (Figure 6.13), we can see that the objective function (Figure 6.13-a) is 
not smooth for all a t . Note that Cty optimal > oj v , nominal , thus the optimal performance 
is above the LEVEL 1 boundary (yaw quickness oc a^). From Figure 6.13 we also 
conclude that the other objective function candidates are not smooth everywhere (al- 
though RMS stroke looked better). Decreasing v for actuators with fixed rate and 
stroke limits causes the actuators to act (almost) like relays. Indeed from Figure 6.14 
it can be seen that actuators with v < 0.65 have “limit-cycle” response type. That is, 
they may achieve the same performance level but with much higher effort as shown in 
Figure 6.15. Parameter changes for this trade-off study are shown in Figure 6.16. 

6.5 Robustness tests 
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V 

Figure 6.17: 10 kts perturbed hover level-flights. 
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Spec 1 : BW and PD 


Spec 2 : Stability margins 


Spec 3 : Quickness Y 





13 

14 

15 


Spec 4 : Coupling R/P 


Spec 5 : Wind-Gust P 




Figure 6.18: Performance for perturbed-hover; A - pitch, y - roll, O - yaw. 


The helicopter performance has been checked for four 10 kts perturbed level-flights 
about hover as shown in Figure 6.17. The results of the nominal optimal design applied 
to the perturbed-hover flight conditions are shown in Figure 6.18. Recall that using 
actuator “energy” as the design objective makes the optimal design converge to some 
(LEVEL 1) boundaries. Therefore using only this design methodology may lead to 
poor robustness. Robustness considerations may be included in the design process as 
it is implemented in the new NCD MATLAR toolbox [22]. 
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7 


Conclusions 


7.1 Design methodology 

• A new rotorcraft FCS design methodology, based on multicriterion optimization, 
was presented. 

• Using this approach, the FCS designer uses optimization (C-O) to tune the 
parameters of a fixed-structure controller. The designer has to monitor the 
process continuously and interrupt if necessary. 

• In addition to his “engineering” skills (knowledge, experience, and intuition), 
the designer has to develop “optimization” skills. 

• Today’s computers are powerful enough to make this method a real design tool. 

7.2 UH-60A in hover - results 

• Level 1 feasible and optimal solutions for the UH-60A in hover were found using 
this multicriterion-optimization-based design method. 

• Higher performance levels may be achieved without changing the helicopter pa- 
rameters, but higher actuator effort is required. The “Level 1 + 1” can not be 
achieved with the current actuators. 

• For level 1 performance, increasing actuator limits does not improve the rotor- 
craft performance or the optimization criterion (except for the obvious reduction 
of actuator effort). 

• The actuator time-constant has naturally an upper bound (200%). Practically 
it also has a lower bound (~ 70%). Below this bound the actuator may oscillate 
as can be seen in Figure 6.14. 

• Using an objective function which “pushes” the optimal solutions to the bound- 
aries of the feasible set leads to poor robustness. 
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7.3 Future work 


Many theoretical and practical questions remain open for further research. First, in 
order to demonstrate the usefulness of this design methodology, it should be applied 
to other design tasks (e.g., other flight conditions, other helicopters, etc.). The hu- 
man/process interface has to be simplified so this method can be used as a real design 
tool. In addition some special issues in modeling, translating handling qualities re- 
quirements, improving robustness, etc., have to be further studied. 

Second, the specific design problem (UH-60A in hover) has to be completed, includ- 
ing: rerunning the trade-off studies for the correct “broken-loop” scheme (see Section 
4), updated parameters (e.g., smaller time-delays), and updated specifications (e.g., 
Spec 3 for yaw channel). 
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A List of all the required computer codes 

A.l C-O problem description files (PDF) 


ADOCS - Main C-O PDF 


/*==================================================*/ 

/* ADOCS - PDF File */ 

/* Gil Yudilevitch ISR 11-11-93 */ 

/*==================================================*/ 

include "dp_adocs" /* Defines design parameters */ 

include "adocs. dp" /* Updates design parameters */ 


dt = 1/30 
tf = 5 
dtg =0.08 
tfg = 40 

global double getoutQ; 

global double geto(name, t, dt) 
global char *name; 
global double t , dt ; 
global { 

global double r; 

global int i ; 

global i = t/dt + 1.5; 

global r = getoutCname, i) ; 

global return r ; 

global } 

include "object. sat" /* objective - actuator RMS rate */ 

include "stable. all" /* stability */ 

include "sped. pit" /* bandwidth vs. phase-delay */ 
include "specl.rol" 
include "sped. yaw" 

include "spec2.pit" /* stability margins */ 

include "spec2.rol" 
include "spec2.yaw" 

include "spec3.pit" /* attitude quickness */ 

include "spec3.rol" 
include "spec3.yaw" 

include "spec4.pit" /* interaxis coupling */ 

include "spec4.rol" 
include "spec4.yaw" 

include "spec5.pit" /* wind gust rejection */ 

include "spec5.rol" 
include "spec5.yaw" 

/*==================== adocs ======================*/ 


spec*.chn - objective and constraint files 

* - Spec number (1,2, 3, 4, 5); chn - channel (pit,rol,yaw) 
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/* OBJECTIVE - Min. Actuator RMS Rates 
/* Ref. briefing 04-94 
/* Included file of ADOCS 

/* Gil Yudilevitch ISR 04-05-94 


==*/ 

*/ 

*/ 

*/ 

*/ 

«*/ 


objective "p.act.rate" 
minimize { 

return getout ("pitch_AE" , 1)-1000; 

} 

good. value = 0.000 
bad.value = 1 

objective "r.act.rate" 
minimize { 

return getout ("roll. AE" , 1)-1000; 

> 

good. value = 0.000 
bad.value = 1 

objective "y.act.rate" 
minimize { 

return getout ("yaw. AE" , 1)- 1000; 

} 

good.value = 0.000 
bad.value = 1 


/* Included file of AD0CS.PDF */ 

/* Gil Yudilevitch ISR 05-14-93 */ 

constraint "stable all" hard 

{ 

return getout ("eigen. A" , 1); 

> 

<= 

good.value « 0 . 000 

bad.value = 0.001 


/*=================== END OF stable. all =====================*/ 

*==============================================================*/ 

/* SPECIFICATION 1 - Small Amplitude, Short Term Response */ 

/* Bandwidth & Phasedelay */ 

/* Pitch (ref. ADS-33C 3.3.2. 1) */ 

/* Included file of AD0CS.PDF */ 

/* Gil Yudilevitch ISR 09-09-92 */ 

/* =====================;==ss====================================== */ 


constraint "pit bw pd" soft 

{ 

return getout ("pitch.dist" , 1) ; 

> 

<= 

good.value = 0.000 
bad.value = 0.002 

constraint "pit Td" hard 

{ 
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return get out ("pitch.pd" , l)-0.4; 

} 

<= 

good. value = 0.0000 
bad.value = 0.0001 


/*================== END OF sped. pit ===s=s=================*/ 

/* SPECIFICATION 1 - Small Amplitude, Short Term Response */ 
/* Bandwidth & Phasedelay */ 
/* Roll (ref. ADS-33C 3.3.2. 1) */ 
/* Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 09-09-92 */ 


constraint M rol bw pd M soft 

{ 

return getout ("roll. dist" , 1); 

> 

<= 

good. value = 0.000 
bad. value = 0.002 

constraint "rol Td" hard 

{ 

return getout ("roll.pd" , l)-0.4; 

> 

<= 

good. value = 0.0000 
bad.value = 0.0001 


/ ^=====- ========== END OF sped. rol ==================*/ 

/* SPECIFICATION 1 - Small Amplitude, Short Term Response */ 
/* Bandwidth & Phasedelay */ 
/* Yaw (ref. ADS-33C 3.3.5. 1) */ 
/* Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 09-09-92 */ 


constraint "yaw bw pd" soft 

{ 

return getout ("yaw.dist" , 1); 

} 

<= 

good. value = 0.000 
bad.value = 0.002 

constraint "yaw Td" hard 

{ 

return getout ("yaw.pd" , l)-0.4; 

> 

<= 

good. value = 0.0000 
bad.value = 0.0001 


/+================ END OF sped. yaw ==================*/ 

/* SPEC 2 - Small Amplitude, Mid Term Response */ 

/* Relative Stability (replaces: Damping Ratio) */ 

/* Pitch (ref. ADS-33C 3. 3. 2. 2, briefing 10-93) */ 

/* Included file of AD0CS */ 


69 



/* Gil Yudilevitch ISR 11-11-93 */ 

/*= = = = = = = == = = = == ====™=========================== s= :===*/ 


constraint "pit damp" soft 

{ 

return getout ("pitch.damp" , 1) ; 

} 

<= 

good_value = 0.000 
bad_value = 0.001 


/*=================== spec2.pit ============= 

/*== === ======= === ======:= = ==== ======================; 

/* SPEC 2 - Small Amplitude, Mid Term Response 
/* Relative Stability (replaces: Damping Ratio) 
/* Pitch (ref. ADS-33C 3.3. 2.2, briefing 10-93) 
/* Included file of AD0CS 

/* Gil Yudilevitch ISR 11-11-93 

/, ======================s======================== 

constraint "rol damp" soft 

{ 

return getout ("roll.damp" , 1); 

> 

<= 

good.value = 0.000 
bad.value = 0.001 


:*/ 

:*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
= */ 


/♦=====================================================*/ 

/* SPEC 2 - Small Amplitude, Mid Term Response */ 
/* Relative Stability (replaces: Damping Ratio) */ 
/* Pitch (ref. ADS-33C 3. 3. 5. 2, briefing 10-93) */ 
/* Included file of AD0CS */ 
/* Gil Yudilevitch ISR 11-11-93 */ 


constraint "yaw damp" soft 

{ 

return getout ("yaw_damp" , 1) ; 

} 

<= 

good_value = 0.000 
bad_value = 0.001 


/*=================== spec2.yaw ==============: 

/* = = = = = = = = = = = = = = = = = = = = = = = = === = = = = = === = = = = = = = = ======: 

/* SPEC3 - Moderate Amplitude, Attitude Quickness 

/* q_pk/theta_pk 

/* Pitch (ref. ADS-33C 3.3.3) 

/* Included file of AD0CS 

/* Gil Yudilevitch ISR 11-11-93 

/* =============================================;===; 

constraint "pit quickl" soft 

{ 

return getout ("pitch.rls" , 1); 

> 

>= 

good. value = 0.00 

bad.value = -0.06 


:=*/ 

= */ 

*/ 

*/ 

*/ 

*/ 

*/ 

:*/ 
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constraint "pit quick2" soft 

{ 

return getout ("pitch_r2s" , 1) ; 

> 

>= 

good.value = 0.00 

bad.value = -0.04 

constraint "pit quick3" soft 

{ 

return getout ("pitch_r3s" , 1) ; 

} 

>= 

good_value = 0.00 

bad.value = -0.03 


/* SPEC3 - Moderate Amplitude, Attitude Quickness 

/* p.pk/phi.pk 

/* Roll (ref. ADS-33C 3.3.3) 

/* Included file of AD0CS 

/* Gil Yudilevitch ISR 11-11-93 

constraint "rol quickl" soft 

{ 

return getout ("roll. r Is" , 1); 

> 

>= 

good. value = 0.00 

bad.value = -0.014 

constraint "rol quick2" soft 

{ 

return getout ("roll_r2s" , 1); 

> 

>= 

good. value = 0.00 

bad.value = -0.08 

constraint "rol quick3" soft 

{ 

return getout ("roll_r3s" , 1); 

> 

>= 

good. value = 0.00 

bad.value = -0.07 


:==*/ 

:=*/ 

*/ 

*/ 

*/ 

*/ 

*/ 

: = */ 


/* SPEC3 - Moderate Amplitude, Attitude Quickness */ 

/* r.pk/psi.pk */ 

/* Yaw (ref. ADS-33C 3.3.6) */ 

/* Included file of AD0CS */ 

/* Gil Yudilevitch ISR 11-11-93 */ 

constraint "yaw quickl" soft 

{ 

return getout ("yaw.r Is" , 1); 

> 

>= 
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good. value = 0.00 

bad.value = -0.1 

constraint "yaw quick2" soft 

{ 

return getout ("yaw_r2s" , 1) ; 

> 

>= 

good. value = 0.00 

bad.value = -0.07 

constraint "yaw quick3" soft 

return getout ("yaw_r3s" , 1) ; 

> 

>= 

good. value = 0.00 

bad.value = -0.04 


/* SPECIFICATION 4 - Decoupling */ 
/* theta/delta.phi */ 
/* Pitch (ref. ADS-33C 3. 3. 9. 2) */ 
/* Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 12-23-92 */ 


functional. constraint "pit dec up" soft 
for t from 0 to 4 by dt 
{ import dt ; 

return geto("pitch_d" , t, dt)-0.25; > 
<= good.curve = { return 0.00; } 
bad.curve = { return 0.05; } 

functional.constraint "pit dec lo" soft 
for t from 0 to 4 by dt 
{ import dt ; 

return geto("pitch_d" , t, dt)+0.25; } 
>= good.curve = { return 0.00; } 
bad.curve = { return -0.05; } 


/*=================== END OF spec4 . pit =====================*/ 

/* SPECIFICATION 4 - Decoupling */ 
/* phi/delta-theta */ 
/* Roll (ref. ADS-33C 3. 3. 9. 2) */ 
/* Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 12-23-92 */ 


functional.constraint "rol dec up" soft 
for t from 0 to 4 by dt 
{ import dt ; 

return geto("roll.d" , t, dt)-0.25; } 
<= good.curve = { return 0.00; } 
bad.curve - { return 0.05; } 

functional.constraint "rol dec lo" soft 
for t from 0 to 4 by dt 
{ import dt ; 

return geto("roll_d" , t, dt)+0.25; } 
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>= good_ curve = { return 0.00; } 
bad.curve = { return -0.05; } 

/*================ END OF spec4.rol ================== 

/* SPECIFICATION 4 - Decoupling 

/* yaw/collective 

/* Yaw (ref. ADS-33C 3.3.9. 1) 

/* Included file of AD0CS.PDF 

/* Gil Yudilevitch ISR 04-29-93 

functional_constraint "yaw decl u" soft 
for t from 3 to tf by dt 
{ import dt ; 

return geto ("yaw_dl" , t-3, dt)-5; } 

<= good.curve = { return 0.0; > 
bad_curve = { return 0.5; } 

functional_constraint "yaw decl 1" soft 
for t from 3 to tf by dt 
{ import dt ; 

return geto ("yaw_dl" , t-3, dt)+5; } 

>= good_curve = { return 0.0; } 
bad_curve = { return -0.5; } 

constraint "yaw dec2 d" soft 

{ 

return getout ("yaw_d2" , 1); 

} 

<= 

good_value = 0.000 
bad_value = 0.002 


*/ 


*/ 

*/ 

*/ 

*/ 

*/ 


/*================ END OF spec4 . yaw ======= 

/* SPECIFICATION 5 - Wind-Gust Rejection 
/* Pitch (ref. M. Tischler 9/26/90) 

/* Included file of AD0CS.PDF 

/* Gil Yudilevitch ISR 09-09-92 


functional.constraint "p gust p u" soft 
for t from 0 to 10 by atg 
{ import dtg; 

return geto("pitch_g" , t, dtg) -4; > 
<= good.curve = { return 0.0; > 
bad_ curve = { return 0.3; > 


functional_constraint "p gust p 1" soft 
for t from 0 to 10 by atg 
{ import dtg; 

return geto ("pitch_g" , t, dtg) +4; > 

>= good.curve = { return 0.0; > 
bad_curve = { return -0.3; > 

functional_constraint "p gust t u" soft 
for t from 10+dtg to tfg by dtg 
{ import dtg; 

return geto("pitch_g" , t, dtg) -0.4; } 
<= good.curve = { return 0.00; > 


*/ 


:=====*/ 

*/ 

*/ 

*/ 

*/ 

=====*/ 
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bad_curve = { return 0.03; } 

f unctional_constraint "p gust t 1" soft 
for t from 10+dtg to tig by dtg 
{ import dtg; 

return geto( ,, pitch_g" , t, dtg) +0.4; } 
>= good_curve = { return 0.00; } 
bad.curve = { return -0.03; } 


/*=================== END OF spec5 . pit =====================*/ 

/* SPECIFICATION 5 - Wind-Gust Rejection */ 
/* Roll (ref. M. Tischler 9/26/90) */ 
/* Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 09-09-92 */ 


functional.constraint "r gust p u" soft 
for t from 0 to 10 by dtg 
{ import dtg ; 

return geto ("roll_g" , t, dtg) -4; } 

<= good_curve = { return 0.0; } 
bad_curve = { return 0.3; } 

functional_constraint "r gust p 1" soft 
for t from 0 to 10 by atg 
{ import dtg; 

return geto("roll_g" , t, dtg) +4; } 

>= good.curve = { return 0.0; > 
bad.curve = { return -0.3; } 

f unctional_constraint "r gust t u H soft 
for t from 10+dtg to tfg by dtg 
{ import dtg ; 

return geto ("roll_g" , t, dtg) -0.4; } 
<= good_curve = { return 0.00; } 
bad_ curve = { return 0.03; } 

f unctional_constraint M r gust t 1" soft 
for t from 10+dtg to tfg by dtg 
{ import dtg; 

return geto ( "roll_g" , t, dtg) +0.4; } 
>= good_curve = { return 0.00; } 
bad.curve = { return -0.03; } 


/*================ END OF spec5 . rol ==================*/ 

/* SPECIFICATION 5 - Wind-Gust Rejection */ 
/* Yaw (ref. M. Tischler 9/26/90) */ 
/♦ Included file of AD0CS.PDF */ 
/* Gil Yudilevitch ISR 09-09-92 */ 


functional.constraint M y gust p u" soft 
for t from 0 to 10 by dtg 
{ import dtg ; 

return getoC'yaw.g" , t, dtg) -4; > 
<= good_ curve = { return 0.0; } 
bad_ curve = { return 0.3; > 

f unctional.constraint "y gust p 1" soft 
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for t from 0 to 10 by dtg 
{ import dtg; 

return geto("yaw_g" , t, dtg) +4; } 

>= good.curve = { return 0.0; } 
bad.curve = { return -0.3; } 

functional_constraint "y gust t u" soft 
for t from 10+dtg to tfg by dtg 
{ import dtg ; 

return geto( M yaw_g M , t, dtg)-0.4; > 

<= good.curve = { return 0.00; } 
bad_curve = { return 0.03; } 

functional.constraint "y gust t 1" soft 
for t from 10+dtg to tfg by dtg 
{ import dtg; 

return geto("yaw_g M , t, dtg) +0.4; > 

>= good.curve = { return 0.00; > 
bad.curve = { return -0.03; } 

/*================ END OF specS. yaw ==================*/ 


A. 2 MATLAB simulation files 


init.m - Initialization file (run only once for each C-0 run) 

% *************** ************************************************************** 
7* System Initialization File for AD0CS 

7. init.m C0NS0L-MATLAB file 

y, Cont inous-Linear Model for specs: 1 (Bandwidth-Phase delay) & 2 (stability 

7* margins) & 5 (Wind-gust) . 

7, Discrete-Nonlinear Model for specs: 3 (Quickness) & 4 (coupling). 

7, Gil Yudilevitch ISR - UMD 04-09-94 

y # ***************************************************************************** 

7. Optimization Set-up 

7* 


0PSYS 

MATLAB 

CONSOL 

LEVEL 

LIMIT 

TIME 

SPEC1 

SPEC2 

SPEC3 

SPEC4 

SPECS 

FLIGHT 


l; 7. 
l; 7. 
0 ; 7 , 
0; 7. 
l; 7, 
l; 7. 
i; 7. 
l; 
i; 
i; 
i; 

’h’ ; 


Operating system: 0 - DOS (PC); 1 - UNIX (Working station). 
Matlab run type: 0 - C-0/MATLAB run; 1 - autonomous MATLAB run. 
C-0 run type: 0 - Background; 1 - interactive. 

Contineuos performance level (0,1): 0 - Level 1, 1 - Level 1+. 
Actuator limits: actual_limit = LIMIT*nominal_limit . 

Actuator time const. (TC) : actual_TC = TIME*nominal_TC . 

Specs: 0 - Specs are not included; 1 - Specs are included. 


7. 

7. Flight conditions (about hover) 

7. 


f 

1 h r 10 kts each direction 
b 


7. System Block Diagram 
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X General Information 

X 

dt = 1/30; 

tf = 5; t =0:dt:tf; nt=length(t) ; 

t 1= min(f ind(t==l) ) ; 

t3= min(f ind(t==3) ) ; 

dtg=0.08; tfg=40; 

tg=0 : dtg : tf g; 

nlO=max(f ind(tg<=10) ) ; nfg=length(tg) ; 
wo=logspace(-l , 1 ,50) ; 


X Sampling rate 30 Hz 
X Command Type Time Axis 

X Index for 1 & 3 sec. 

X Time vector for wind-gust inputs 

X Frequency vector 


X Model Components 

X 

X 1. Helicopter 6 DOF Dynamics + Rotor Aerodynamics 
X Linear Continuous Time Model 

X # of states =11 C 9 for 6 dof dynamics + 2 for rotor aerodynamics ) 

X # of inputs = 4 

*/ # # of outputs =7 ( 4 for the linear case — > C 4 x 11 ) 


State 


Output Input 


X u - linear velocity along X axis 

X v - linear velocity along Y axis 

X w - linear velocity along Z axis 

X p - angular velocity about X axis 

X q - angular velocity about Y axis 

X r - angular velocity about Z axis 

X phi - single about X axis 

X theta - angle about Y axis 

X psi - angle about Z axis 

X blc - longitudinal flap (-als) 

X bis - lateral flap (-bis) 

X 


deltac 


delta_phi 

delta.theta 

delta.psi 


Units: linear velocity [ft /sec] 

angular velocity [rad/sec] 

helicopter angle [rad ] 
flap angle [rad ] 


* - used for NL only 

delta.# [in] 


B10to4 = zeros(10,4); X Trans. 10 (UMGENHEL) — > 4 inputs 

B10to4 (1 , 2) = 1; B10to4(2 , 1) = 1; B10to4(4,3) = 1; B10to4(3,4) = 1; 

X Continueous Time 

X 


if OPSYS == 1, 

eval ( [ 9 load All * .FLIGHT , ’ -ascii;’]); X Load A,B UMGENHEL matrices for Unix 

eval([’load Bll FLIGHT, ’ -ascii;’]); '/, for the FLIGHT conditions 

eval ( [ ’ Ap = All’, FLIGHT, ’;’]); 

eval ([’Bp = Bll’, FLIGHT, ’*B10to4; ’]); 

eval([’load all’ , FLIGHT, ’.;’]) ; X Load A,B UMGENHEL matrices for PC 

eval([’load bll’ , FLIGHT, ’.;’]) ; X for the FLIGHT conditions 

eval( [ ’ Ap = all’, FLIGHT, ’;’]); 
eval ([’Bp = bll’, FLIGHT, ’*B10to4; ’]); 
end; 

Cp =[00000001000 
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00000010000 
00000000100 
0000010000 0 ]; 

Dp = zeros (4, 4) ; 

[Apm,Bpm,Cpm,Dpm]=modred(Ap,Bp,Cp,Dp, [10,11]) ; 7. Reduced to 9 states for 

'/, "inverse plant" parameters 


7, Discrete Time 

7. 

[Apd.Bpd] = c2d(Ap,Bp ,dt); 7. digital ZOH equivalence for the plant 

7, Pure Delay 2_nd Order Pade Approximation (for the continuous linear part !!) 

7. 

’/ t 

7. Total Delay was taken equal for all channels. Total delay for Pitch 
7. from Mark's AIAA paper is 223 ms ==> 200 ms "pure" and 25 ms Actuator 
7, Time-Constant (see later in SP-Actuator Model) 

Td = [0 . 2 ; 0 . 2 ; 0 . 2 ; 0 . 2] ; 

[Adi ,Bdl ,Cdl ,Ddl] = pade(Td(l) ,2) ; 

[Ad2 , Bd2 , Cd2 , Dd2] = pade(Td(2) ,2) ; 

[Ad3 , Bd3 , Cd3 , Dd3] = pade(Td(3) ,2) ; 

[Ad4 , Bd4 , Cd4 , Dd4] = pade(Td(4) ,2) ; 

[Ad , Bd , Cd , Dd] =append ( Adi , Bdl , Cd 1 , Dd 1 , Ad2 , Bd2 , Cd2 , Dd2) ; 

[Ad , Bd , Cd , Dd] =append (Ad , Bd , Cd , Dd , Ad3 , Bd3 , Cd3 , Dd3) ; 

[Ad , Bd , Cd , Dd] =append ( Ad , Bd , Cd , Dd , Ad4 , Bd4 , Cd4 , Dd4) ; 

Ndel = round(Td/dt) ; 7. # of delayed sampling intervals (for NL computation) 

'/, Swashplate- Actuators Model 

7. 


7 . LINEAR PART 

K = l/(TIME*0.025)*ones(l,4) ; 7 . l/(Time Constant) equal actuators 

[asl ,bsl , csl ,dsl] = tf2ss( [0,K(1)] , [1 ,K(1)] ) ; 

[as2,bs2,cs2,ds2] = tf 2ss( [0,K(2)] , [1 ,K(2)] ) ; 

[as3,bs3 ,cs3 ,ds3] = tf2ss( C0,K(3)] , [1 ,K(3)] ) ; 

[as4 ,bs4 , cs4 , ds4] - tf2ss( [0,K(4)] , [1 ,K(4)] ) ; 

[As , Bs , Cs , Ds] = append(asl ,bsl ,csl ,dsl ,as2,bs2,cs2,ds2) ; 

[As ,Bs ,Cs ,Ds] = append(As,Bs,Cs,Ds,as3,bs3,cs3,ds3) ; 

[As ,Bs ,Cs ,Ds] = append ( As ,Bs ,Cs ,Ds,as4,bs4,cs4,ds4) ; 


X NONLINEAR SATURATIONS :- 

X *** All data is given at cockpit units (i.e., in's of stick or pedal) 

X *** The trim (hover) conditions set to be zero (see table below) 

X *** The swashplate mechanizem ("limits coupling") is NOT taken in acount 
•/, *** The rate limits are taken as: full strok per 1 sec 


X Command Limits Table, Ref. Sikorsky SER 70452 p 6.16 Fig. 6.3.1 

X 

X Channei I Pitch I Roll I Yaw I Collective I 

X actual 1-5.0 +0.2 +5.01-5.0 -0.5 +5.0 I -2.69 +0.85 +2.69 1 0.0 +5.0 +10.0] 

X simulation I -5 . 2 0.0 +4.81-4.5 0.0 +5.51-3.54 0.00 +1.841-5.0 0.0 + 5.0 I 


Csl = LIMIT* [ -5.2 -4.5 -3.54 -5] 

Csu = LIMIT* [ 4.8 5.5 1.84 5] 

Rsl = LIMIT* [-10 -10 -5.38 -10] 

Rsu = LIMIT* [ 10 10 5.38 10] 


X Displacement (Commands) Lower Limits 
X Displacement (Commands) Upper Limits 
X Rate Lower Limits 
X Rate Upper Limits 


X Linear Continuous -Time Open-Loop 
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[Ao, Bo, Co, Do] = series(Ad,Bd,Cd,Dd,As,Bs,Cs,Ds) ; 
[Ao, Bo, Co, Do] = series(Ao,Bo,Co,Do,Ap,Bp,Cp,Dp) ; 

7, Closed-Loop (Design) Parameters, Initial Values 
% 


*/ f Design parameters 
% 


if MATLAB == 1, 
dp.NOM 

7.Kr_p=0; Kp_r=0; Kc_y=0; 7. Crossfeed gains (for decentralized control) 
end; 

7, Inverse plant (ff) constants 

7 . 


FGtet = Bpm (5,1) ; FGphi = Bpm(4,2); FGpsi = Bpm(6,3); 

FTtet = -Apm(5,5); FTphi = -Apm(4,4); FTpsi = -Apm(6,6); 

7* Time Response Inputs 

7. 

DtR = pi/180; 

Stet = DtR*[ 5,17.5,30]; 

Sphi =-DtR*[10,35 ,60]; 7. the worst direction (nonsymmetric saturation) 

Spsi = DtR* [10,35 ,60]; 

Scol = 5; 

7. Linear Wind-Gust Model 

7. 

[ag,bg,cg,dg] = tf 2ss ( [0 0.44 0] , [1 2 1]); 

[Ag , Bg , Cg , Dg] =append (ag , bg , eg , dg , ag , bg , eg , dg) ; 

[Ag , Bg , Cg , Dg] =append ( Ag , Bg , Cg , Dg , ag , bg , eg , dg) ; 

[Ag , Bg , Cg , Dg] =append (Ag , Bg , Cg , Dg , [],[],[], 0) ; 

Bgg=zeros (23 , 4) ; 

Bgg(17 , 1) =-Apm(5 , 5) ; Bgg(16 , 2) =-Apm(4 ,4) ; Bgg(18,3)=-Apm(6,6) ; 


7. Level 1 curve for spec 1 

7. 


Ts = [0.000 0.025 0.050 0.075 

0.225 0.250 0.275 0.300 

Ws = [2.005 2.005 2.005 2.005 

2.405 2.685 3.005 3.275 

PLl=polyf it (Ts ,Ws ,6) ; 

Ws = Ws + 1 . 5*LEVEL ; 

PL =polyf it(Ts,Ws,6) ; 


0.100 0.125 0.150 0.175 0.200 ... 
0.325 0.350 0.375 0.400] ; 

2.005 2.005 2.005 2.105 2.235 ... 
3.505 3.905 4.155 4.455] ; 


7, LEVEL factors for spec 3 

7. 


d3pl =0.93 
d3rl =0.96 
d3yl =0.98 


d3p2 =0.78 
d3r2 =0.50 
d3y2 =0.76 


d3p3 =0.68 
d3r3 =0.10 
d3y3 =0.64 


7. Optimization Parameters (optional for interactive C-0/MATLAB run) 
7. 


if MATLAB == 0 & CONSOL == 1, 

CONS = [1:3,2,4,6,8:16,1,3,17,5:2:17]; 

BAD = [3 ; 3 ; 3 ; 0 . 002 ; 0 . 002 ; 0 . 002 ; 0 . 01 ; 0.01; 0.01; 0.04; 0.03; 0.09; 0.08; . . . 
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0 . 07 ; 0 . 04 ; 0 . 05 ; 0 . 05 ; 0 . 002 ; 0.5;0.3:0.03;0.3;0.03;0.3;0. 03] ; 

Iter=-1; iter=[]; witer=[] ; www=[J; kkk=U; 
perf = [] ; dps=[]; grad=[] ; bad=BAD; 
end; 

*/, SIMU.MAT saved variables, default values 

•/• 

pitch_dist=0; roll_dist=0; yaw_dist=0; pitch_bw =0; roll_bw =0; yaw_bw =0; 
pitch_pd =0; roll.pd =0; yaw.pd =0; pitch_damp=0; roll_damp=0; yaw_damp=0; 
pitcher Is =0; roll_rls =0; yaw_rls =0; pitch_r2s =0 ; roll_r2s =0; yaw_r2s =0; 

pitch_r3s =0; roll_r3s =0; yaw_r3s =0; pitched =0; rolled =0; yaw_dl =0; 

yaw_d2 =0; pitch.g =0; roll_g =0; yaw_g =0; eigen.A =0; OBJ =0; 

pitch.Wco =0; roll.Wco =0; yaw.Wco =0; pitch_AE =0; roll_AE =0; yaw.AE =0; 

Name =, Gil Yudilevitch’ ; 

Date=amdate; 

************** end of init.m ******************************************** 


simu.m - Main simulation file 


***************************************************************************** 
V, System Simulation File for AD0CS 

7 . simu.m C0NS0L-MATLAB file 

*/* Continous-Linear Model for specs: 1 (Bandwidth-Phase delay) & 2 (stability 
% margins) & 5 (Wind-gust). 

7 % Discrete-Nonlinear Model for specs: 3 (Quickness) & 4 (coupling), 

•/. Gil Yudilevitch ISR - UMD 04-09-94 

'/ # ***************************************************************************** 


7 % Feedforward (including Model Following & "Inverse Closed-Loop") 

7 % 

if MATLAB==1, disp( 9 Feedforward control ’) ; end; 

7 % Continuous Time 

7 . 

[Af tet ,Bf _tet ,Cf _tet ,Df _tet] = ... 

tf 2ss (Mtet~2* [1/FGtet Kq+l/FGtet/FTtet Ktet] , [1 2*Mtet Mtet~2]); 

[Af phi,Bf_phi,Cf_phi,Df_phi] = ... 

tf 2ss(Mphi~2* [1/FGphi Kp+l/FGphi/FTphi Kphi] , [1 2*Mphi Mphi~2]); 

[Af _psi,Bf_psi,Cf_psi,Df_psi] = ... 

tf 2ss ( Mpsi* [1/FGpsi Kr+l/FGpsi/FTpsi Kpsi] , [1 Mpsi 0] ) ; 

[Af ,Bf ,Cf ,Df]=append(Af _tet ,Bf _tet ,Cf _tet ,Df _tet,Af _phi,Bf_phi,Cf _phi,Df_phi) ; 
[Af ,Bf ,Cf ,Df]=append(Af ,Bf ,Cf ,Df ,Af_psi,Bf_psi,Cf_psi,Df_psi) ; 

[Af , Bf , Cf , Df ] =append ( Af , Bf , Cf , Df , [] ,[],[],!); 

'/, Discrete Time 

•/. 

[Afd.Bfd] = c2d(Af ,Bf ,dt) ; 

*/. Crossfeed design 

7 . 

if MATLAB==1, disp( ’Crossfeed control’); end; 

Kef = [1 Kr_p 0 0 
Kp_r 1 00 
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001 Kc_y 

0 0 0 1 ]; 

Bocf = Bo*Kcf; Docf = Do*Kcf ; 

# /, Stabilization Feedback Gains Matrix 
% 


if MATLAB==1, disp ( 9 Feedback control’); end; 

'/, u v w p q r phi theta psi blc bis 
H = [ ... 

0 0 0 0 Kq 0 0 Ktet 0 0 0 V. 

0 0 0 Kp 0 0 Kphi 0000 % 

0000 OKrO 0 Kpsi 0 0 '/, 

0000000 0 0 0 0]; '/. 

'/, Linear Closed-Loop 

X 

*/, order and # of states: 

*/, 6 - Feedforward 

•/, 8 - Delay (4 x 2nd order Pade apprx.) 

*/, 4 - Swashplate actuators 

'/, 11 - 6 DOF + rotor (outputs: theta, phi, psi, r) 

HH=[zeros(4, 12) ,H] ; 

Ac=Ao-Bocf *HH; 
eigen_A=max (real (eig (Ac) ) ) ; 

[A,B,C,D] =series(Af ,Bf ,Cf ,Df , Ac , Bocf , Co , Docf) ; 

'/, Linear "Broken-Loop” (open-loop) 

y. 

HH(1 , 17) = 0; HH(1 , 20) = 0; 

[Aol ,Bol ,Col , Dol] = . . . 

series(Ao-Bocf *HH,Bocf ( : ,1) ,Cor(l , : ) ,Docf (1 , 1) ,0,l,Ktet,Kq) ; 
HH( 1 , 17) = Kq; HH(1,20) = Ktet; 

HH(2 , 16) = 0; HH(2,19) = 0; 

[Ao2 ,Bo2 ,Co2 , Do2] = ... 

series (Ao-Bocf *HH, Bocf ( : ,2) ,Cor(2, : ) ,Docf (2,2) ,0, l,Kphi,Kp) ; 
HH(2, 16) = Kp; HH(2,19) = Kphi; 

HH(3, 18) = 0; HH(3,21) = 0; 

[Ao3 , Bo3 , Co3 , Do3] = ... 

series (Ao-Bocf *HH , Bocf ( : ,3) ,Cor(3, : ) ,Docf (3,3) ,0, l,Kpsi,Kr) ; 
HH(3 , 18) = Kr; HH(3,21) = Kpsi; 

•/. Nonlinear Closed-Loop (Time Response) 

y. 

y. Command Response | oredr and # of states : 

X 6 - Feedforward 

'/, 4 - Swashplate actuators 

'/, 11 - 6 DOF + rotor (outputs: theta, phi, psi, p, q, r, w) 

if MATLAB==1, disp( Nonlinear step response:’); end; 

*/, Pitch input 

% 


delta_theta 

delta_phi 

delta_psi 

delta-collective 


nR=l ; 

if SPEC3 == 1, 

aR=pilot(t ,Stet(3) ,Stet(l) , ’p’) ; drsc; Xll = X; Urll = Us; 
if MATLAB == 1, 

disp(’ Pitch Small’); 

Usll = Xs ( 1 ; nt , : ) ; 
end; 
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aR=pilot(t ,Stet (3) ,Stet(2) , ’p’) ; drsc; X12 = X; 
if MATLAB==1 , 

disp(’ Pitch Medium’); 

Url2 = Us; Usl2 = Xs(l:nt,:); 
end ; 
end; 

if (SPEC3+SPEC4) >= 1, 

aR=pilot (t ,Stet (3) ,Stet (3) , ’p’ ) ; drsc; X13 = X; 
if MATLAB==1 , 

disp(’ Pitch Large’); 

Url3 = Us; Usl3 = Xs(l:nt,:); 
end; 
end; 

7. Roll input 

7. 

nR=2; 

if SPEC3 == 1, 

aR=pilot (t ,Sphi (3) ,Sphi(l) , ’p’) ; drsc; X21 = X; Ur21 = Us; 
if MATLAB == 1, 

disp(’ Roll Small’); 

Us21 = Xs(l :nt , : ) ; 
end; 

aR=pilot(t ,Sphi(3) ,Sphi(2) , ’p’) ; drsc; X22 = X; 
if MATLAB==1, 

disp(’ Roll Medium’); 

Ur22 = Us; Us22 = Xs(l:nt,:); 
end; 
end; 

•if (^PFr^+^PFr^ >= i 

aR=pilot(t,Sphi(3),Sphi(3),’p’); drsc; X23 = X; 
if MATLAB==1 , 

disp(’ Roll Large’); 

Ur23 = Us; Us23 = Xs(l:nt,:); 
end; 
end; 

7, Yaw input 

7 . 


nR=3 ; 

if SPEC3 == 1 

aR=pilot(t ,Spsi(3) ,Spsi(l) , ’r’) ; drsc; X31 = X; Ur31 = Us; 
if MATLAB == 1, 

disp(’ Yaw Small’); 

Us31 = Xs(l :nt , : ) ; 
end; 

aR=pilot(t,Spsi(3) ,Spsi(2) , ’r’) ; drsc; X32 = X; 
if MATLAB==1 , 

disp(’ Yaw Medium’); 

Ur32 = Us; Us32 = Xs(l:nt,:); 
end; 

aR=pilot (t ,Spsi (3) ,Spsi (3) , ’r ’ ) ; drsc; X33 = X; 
if MATLAB==1 , 

disp( ’ Yaw Large’) ; 

Ur33 = Us; Us33 = Xs(l:nt,;); 
end; 
end; 

7. Collective input 
% 

nR=4 ; 

if SPEC4 == 1, 
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drsc; X41 = X; 


aR=pilot (t ,Scol ,Scol , ’p’) ; 
if MATLAB-=1 , 

disp( ’ Collective’ ) ; 

Ur41 = Us; Us41 = Xs(l:nt,:); 
end; 
end; 

if SPEC5 == 1, 

% Linear Wind Gust response 



*/, 6 - Gust model 

% 8 - Pure delay 

•/, 4 - Swashplate actuators 

7, 11 - 6 DOF + rotor (outputs: theta, phi, psi) 


[Age , Bgc , Cgc , Dgc] = ser ie s ( Ag , Bg , Cg , Dg , Ac , Bgg , Co , Docf ) ; 

[ygl,x] = step(Agc ,Bgc( : , 1) ,Cgc(l , : ) ,Dgc(l, 1) , l,tg) ; 
pitch up=x(:,08); pitch_ur=K(l) * (x( : ,08)-x( : , 15)) ; 

[yg2,x] = step (Age , Bgc ( : ,2) , Cgc (2 , : ) , Dgc (2 ,2) , 1 ,tg) ; 
roll.up =x( : , 10) ; roll_ur =K(2)*(x( : , 10)-x( : , 16)) ; 

[yg3,x] = step (Age , Bgc ( : , 3) , Cgc (3 , : ) , Dgc (3 , 3) , 1 , tg) ; 
yaw_up =x(:,12); yaw.ur =K(3)*(x( : , 12)-x( : , 17)) ; 
if MATLAB==1 , disp( ’Linear wind-gust response’); 
if max(pitch_up) > Csu(l) I ... 

min(pitch^up) < Csl(l) I max(abs(pitch_ur)) > abs(Rsl(l)), 
disp ( ’ ~ Warning: Pitch actuator is saturated !’) 

end; 

if max(roll_up) > Csu(2) I ... 

min(roll_up) < Csl(2) I max(abs(roll_ur)) > abs(Rsl(2)), 
disp(’ Warning: Roll actuator is saturated !’); 

end; 

if max(yaw_up) > Csu(3) I ... 

min(yaw_up) < Csl(3) I max(abs(yaw_ur)) > abs(Rsl(3)), 

(jisp ( , Warning: Yaw actuator is saturated !’); 

end; 
end; 

end; 


•/. New objectives (4/94) 

7 . 

*/, Quadratic objectives (actuator "energy") 

% 

pitch_AE = qcost (dt ,Urll ( : , 1) , 1) ; 
roll.AE = qcost (dt ,Ur21 ( : ,2) , 1) ; 
yaw_AE = qcost (dt ,Ur31 ( : , 3) , 1) ; 

*/, Actuator efforts 

y. 

effl = sqrt (qcost (dt,Urll(: ,1) ,l)/5)/10; 
eff2 = sqrt (qcost (dt ,Ur21 (: ,2) , l)/5)/10; 
eff3 » sqrt (qcost (dt ,Ur31( : ,3) , l)/5)/5. 38; 

if MATLAB==1 , disp (’Computing specs performance:’); end; 

X Spec 1 

y. 
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if SPEC1 == 1, 

if MATLAB==1 , disp(> 

[pitch.dist ,pitch.bw,pitch_pd] 

[roll.dist ,roll_bw ,roll_pd ] 

[yaw_dist ,yaw.bw ,yaw_pd ] 
end; 

% Spec 2 

•/. 

if SPEC2 == 1, 

if MATLAB == 1, 

7, zeta is not used for optimization anymore 

[Zeta, max. wn] = zeta(A ,max( [pitch_bw,roll_bw,yaw_bw] ) ) ; 7, [ ] , [ ] 

disp( * Spec 2 } ) ; 

end; 

7, we are using GM k PM criterion instead of zeta 
GM0=6; PM0=45; 7, standard gain and phase margin 
[mol ,pol]=bode(Aol ,Bol ,Col ,Dol , 1 ,wo) ; 

[Gm,pitch.PM,Wg,pitch.Wco] = imargin(mol ,pol , wo) ; pitch_GM = 20*logl0(Gm) ; 
d.g.p = (pitch.GM/GM0-l)~2; d.p.p = (pitch.PM/PMO-1) *2; 

if pitch.GM >= GMO k pitch.PM >= PMD, pitch.damp = 0; 

elseif pitch.GM >- GMO k pitch.PM < PMO, pitch.damp = d.p.p; 

elseif pitch.GM < GMO k pitch.PM >= PMO, pitch.damp = d_g_p; 

else, pitch_damp = d.g.p+d.p.p ; end; 

[mo2 , po2] =bode ( Ao2 , Bo2 , Co2 , Do2 , 1 , wo) ; 

[Gm, roll. PM ,Wg,roll.Wco ] = imargin(mo2,po2,wo) ; roll.GM = 20*logl0(Gm) ; 
d g_r = (roll_GM/GM0-l)^2; d.p.r = (roll_PM/PMO-l) ~2; 

if roll.GM >= GMO & roll.PM >= PMO, roll.damp = 0; 

elseif roll.GM >= GMO k roll.PM < PMO, roll.damp = d.p.r; 

elseif roll.GM < GMO k roll.PM >= PMO, roll.damp = d.g.r; 

else, roll.damp = d.g.r+d.p.r; end; 

[mo3 ,po3] =bode (Ao3 ,Bo3 ,Co3,Do3 , 1 ,wo) ; 

[Gm,yaw_PM ,Wg,yaw.Wco ] = imargin(mo3,po3,wo) ; yaw.GM = 20*logl0(Gm) ; 
d.g.y = (yaw_GM/GMO-l) ~2; d.p.y = (yav_PM/PMO-l) "2; 

if yaw_GM >= GMO k yaw. PM >= PMO, yaw.damp = 0; 

elseif yaw.GM >= GMO & yaw.PM < PMO, yaw.damp = d.p.y; 

elseif yaw.GM < GMO k yaw.PM >= PMO, yaw.damp = d.g.y; 

else, yaw.damp = d.g.y+d.p.y; end; 

end; 

7. Spec 3 
7. 

if SPEC3 == 1 

if MATLAB == 1, disp(' Spec 3>); end; 

pitch.rl = max(Xll(: , 15) ) /Stet (1) ; 7, [1/sec] 

pitch_rls= pitch.rl- (0 . 70+d3pl*LEVEL) ; 

pitch_r2 = max(X12( : , 15))/Stet (2) ; 

pitch_r2s= pitch_r2-(0.40+d3p2*LEVEL) ; 

pitch_r3 = max(X13(: , 15) ) /Stet (3) ; 

pitch_r3s= pitch_r3-(0.25+d3p3*LEVEL) ; 

roll.rl = min(X21(: , 14) ) /Sphi(l) ; 

roll rls = roll rl-(l .39+d3rl*LEVEL) ; 

roll_r2 = min(X22(: , 14) ) /Sphi (2) ; 

roll r2s = roll.r2-(0.85+d3r2*LEVEL) ; 

roll_r3 = min(X23( : , 14)) /Sphi (3) ; 

roll_r3s = roll.r3-(0 . 75+d3r3*LEVEL) ; 

yaw.rl = max(X31 ( : , 16) ) /Spsi (1) ; 


Spec 1') ; end; 

= d.bw_pd(A,B,C,D, 1, 1 ,PL1) ; 7, [ , rad/sec , sec] 
= d_bw_pd(A,B,C,D,2,2 ,PL) ; 

= d_bw_pd(A,B,C,D,3,4,PL) ; 
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yaw_rls = yaw_rl-(l . 42+d3yl*LEVEL) ; 
yaw_r2 = max(X32( : , 16) ) /Spsi (2) ; 
yaw_r2s » yaw_r2-(0. 67+d3y2*LEVEL) ; 
yaw_r3 = max(X33( : , 16) ) /Spsi (3) ; 
yaw_r3s = yaw_r3-(0.36+d3y3*LEVEL) ; 
end; 

*/♦ Spec 4 

X 

if SPEC4 == 1, 

if MATLAB==1 , disp(> Spec 40; end; 

pitched = X23(l : 121 , 18)/Sphi(3) ; X [ ] 

roll.d = X 13(1 : 121, 17)/Stet (3) ; 

yaw dl = 180/pi*X41(t3:nt,16) ; */, [deg/sec] 

Mr 1 = max(X41(: ,16)); Jrl = f ind(X41( ; , 16) == Mrl) ; X for w(t) < 0 

if t ( Jrl) >= t3 , rl = X41(tl,16); else, rl = Mrl; end; % and r(t) > 0 

r3 = X41 (t3 , 16) -rl ; 

y_y = -180/pi*rl/X41 (t3 , 13) ; 

x_y = 180/pi*r3/X41 (t3, 13) ; 

a_y = (x_y-0 . 15) "2 ; b_y = (y_y-0.65) "2; c.y = (x_y+0.2)~2; 
if (x_y >* 0.15) k (y_y < 0.65), 

yaw_d2 = a_y; 

elseif (x_y < -0.2) & (y_y < 0.65), 

yaw_d2 = c_y; 

elseif (x_y >= -0.2) k (x_y < 0.15) k (y_y >= 0.65), 

yav_d2 = b_y ; 

elseif (x_y >= 0.15) & (y_y >= 0.65), 
yaw_d2 = a_y + b_y; 
elseif (x_y < -0.2) & (y_y >= 0.65), 

yaw_d2 = b_y + c_y; 
else, 

yaw_d2 = 0; 
end; 
end; 

•/. Spec 5 

% 

if SPEC5 == 1, 

if MATLAB==1 , disp(’ Spec 5’); end; 

pitch.g = 180/pi*ygl ; */. [deg] 

roll_g = 180/pi*yg2; 
yaw_g = 180/pi*yg3; 

end; 

X 1 objective 

x 

X OBJ = 60*(pitch_Wco+roll_Wco+yaw_Wco)+pitch_AE+6*roll_AE+30*yaw_AE - 1000; 
if MATLAB==0, 

save simu pitch_dist roll_dist yaw.dist . . . 
pitch_bv roll.bw yaw.bw 
pitch_pd roll.pd yaw.pd 
pitch.damp roll.damp yaw.damp . . . 
pitch_Wco roll_Wco yaw_Wco 
pitch_AE roll.AE yaw_AE 
pitch.rls roll.rls yaw.rls 
pitch_r2s roll_r2s yaw_r2s 
pitch_r3s roll_r3s yaw_r3s 


84 



pitch.d roll_d yaw_dl yaw_d2 . . . 

pitch_g roll_g yaw_g eigen_A V.OBJ 

end ; 


x mmmmmm xxxxxxxxxx end of 


xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


*.m - MATLAB functions (used in simit.m) 


function [d,Bw,Pd] = d_bw_pd(A ,B ,C, D , Iu, Iy ,PL) ; 

X Calculate bandwidth [rad/sec] and phase-delay [sec] for 
7, the SISO system (input Iu output Iy) of: 

X dx/dt = Ax + Bu 

X y = Cx + Du 

X Then calculate the distance (d) of (Bw,Pd) for a given boundary 
X curve (PL) . 

X 

X [d,Bw,Pd] = d_bw_pd(A,B,C,D,Iu, Iy) 

X MATLAB function for ADOCS 
X Gil Yudilevitch ISR 11-19-92 

X Calculate Bw 

X 

v=0.5; p=0 ; 
for i = 1:3, 

epsilon = 0.1~(i-l); 
while p > -135, 
q=p; 

w = w+epsilon; 

p=angle(C(Iy , : )*inv( j*w*eye(size(A))-A)*B( : , Iu)+D(Iy, Iu))*180/pi ; 
if p > 0, p=p-360; end; 
end; 

p s q; 

w = w-epsilon; 
end; 

Bw = w+epsilon/2; 

7. Calculate Pd 

X 

p=0; 

for i = 1:5, 

epsilon = 0.1~(i-l); 
while p > -180, 

q=p; 

w = w+epsilon; 

p=angle(C(Iy , : ) *inv( ( j*w*eye(size(A) ) -A) ) *B( : ,Iu)+D(Iy, Iu))* 180/pi ; 
if p > 0, p=p-360; end; 
end; 

p=q; 

w = w-epsilon; 
end; 

w = w+epsilon/2; 

p=angle(C(Iy , : )*inv((j*2*w*eye(size(A))-A))*B( : ,Iu)+D(Iy,Iu))*180/pi-360; 
X Assumption, at 2*wl80 : -180 deg >= phase >= -540 deg !!! 

Pd = -(180+p)*pi/360/w; 

7. Calculate d 
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d=Bw-polyval(PL,Pd) ; 
if d > 0, d=0; 
else, 

dmin=100 ; 
d=(d/4.45)~2; 

PdO==Pd; 

while d < dmin, 
dmin=d ; 

Pd0=Pd0-0 . 005 ; 

d= ( (Pd-PdO) /0 . 4) ~2+ ( (Bw-polyval (PL , PdO) ) /4 . 45) "2 ; 
end; 
d=dmin; 
end; 

function Xd = delay (XX, D,k) 

7, Delays the time vector XX(k) k=l,2,... by D time units 

% MATLAB function for ADOCS 

7, Gil Yudilevitch ISR 14-03-93 

[m,n] = size(XX); 
for i=l:n, 

if D(i) >= k, 

Xd(i) = XX(1 , i) ; 
else 

Xd(i) = XX(k-D(i) , i) ; 
end; 
end; 

) % ************************************************************* 
7, Digital Recursive Simulation Command (inputs) 

*/. Solve NON-LINEAR equations for simu.m (C0NS0L-MATLAB file) 

*/, CAUTION: This is a MATLAB SCRIPT file !!! 

Gil Yudilevitch ISR 02-04-93 

*/ # ************************************************************* 

Xf = zeros (nt ,6 ) ; 

Xs = zeros (nt ,4 ) ; 

Xp = zeros(nt.ll) ; 

R=zeros(nt,4) ; R(:,nR)=aR’; 

for k=l:nt, 

Rm(k , : ) = Xf (k, :)*Cf ’ + R(k, :)*Df ’ ; 

E(k, : ) = Rm(k,:) -Xp(k,:)*H’; 

Ed(k,:) = delay (E, Ndel, k) ; 

Ec(k, : ) = Ed(k,:)*Kcf’; 

Rs(k, : ) = limit(Csl,Csu,Ec(k, :)) ; 

Uu(k , : ) = (Rs(k, :)-Xs(k, :)) .*K; 

Us(k, : ) = limit(Rsl,Rsu,Uu(k, :)) ; 

Xf (k+1, :) = Xf(k,:)*Afd> + R(k,:)*Bfd>; 

Xs(k+1, : ) = Xs(k, : ) + Us(k,:)*dt; 

Xp(k+1 , : ) = Xp(k, : )*Apd’ + Xs(k, : )*Bpd> ; 

end; 

X= [Xf ( 1 : nt , : ) Xs(l:nt,:) Xp(l:nt,:)]; 
function y=limit(l,u,x) 

*/. Saturation fvinction: 

7. 
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7. 

7. 

7. 

7. 

7. 

7. 

7. 


“ y (output component) 

u I / 

1/ 

■ — / > x (input component) 

/I 


7. x,y,l,u are all vectors of the same length 

7. 

7, y = limit(l,u,x) 


7. MATLAB function for ADOCS 
7. Gil Yudilevitch ISR 


n=length(l) ; 
for i=l:n, 

if x(i) >= u(i) , y (i)=u(i) ; 
@ls 6 

if x(i) <= l(i), y(i)=l(i); 
else, y (i)=x(i) ; 

end ; end ; 

function u=pilot(t,r,a,type) 


7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 


type u 


’p’osition I / 

i/r 

/ -> t 


I a 

’r’ate I /\ 

l/r \ 

/ \_ 


-> t 


7, MATLAB function for ADOCS 
7. Gil Yudilevitch ISR 


09-22-92 


for pitch and roll channels 


for yaw channel 


06-02-94 


if type == ’p’ , 

T=max(f ind(t<=a/r)) ; 
u=[r*t(l:T) ,a*ones(l, length (t)-T)] ; 
else , 

T=max(find(t<=sqrt(a/r))) ; 

u= [r*t (1 :T) ,r* (t (T) -t (2 : T) ) , zeros ( 1 , length(t) -2*T+1)] ; 
end; 


A. 3 Some M-files for design evaluation 

specs, m - Performance map (color) 

7. MATLAB M-file (SCRIPT !!!) for PERFORMANCE MAP (COLOR) DISPLAY 
7. 

7. Gil Yudilevitch ISR 12-23-92 

7 . 

clg; mp=4; delta=le-5; 

7. Spec 1 
7. 
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if SPEC1 == 0, 

[pitch_dist ,pitch_bw,pitch_pd] = d_bw_pd(A,B,C,D, 1, 1 ,PL1) ; 

[roll_dist ,roll_bw ,roll_pd ] = d_bw_pd(A,B,C,D,2,2,PL) ; 

[yaw_dist ,yaw_bw ,yaw_pd ] = d_bw_pd(A,B,C,D,3,4,PL) ; 
end; 

wl=0: 0.001: 0.4; 
xl=polyval(PLl ,wl) ; 
xlp=polyval(PL,wl) ; 
subplot (341) ; 
if LEVEL ==0, 

f ill( [0 . 55,xl ,xl(401 : -1 : 1)-1 .45] , [0,wl,wl(401:-l: 1)] , ’r \ . . . 

[xl.6,6,2] , [wl, 0.4, 0,0] ,’b’ ,. . . 

[0,xl- 1.45,0] , [0,wl,0.4] , ’m') ; 

f ill ( [xlp , 6 , 6 , 3 . 5] , [wl, 0.4,0, 0] , ’c\. . . 

[0 . 55,xl ,xl(401 : -1 : 1)-1 .45] , [0,wl,wl(401 :-l : 1)] , ’r’ ,. . . 

[xlp,6 ,xl(401 : -1 : 1) ,3.5] , [wl,0.4,wl(401:-l:l),0] ,’b’ .... 

[0,xl-l .45,0] , [0,wl ,0.4] , ’m’) ; 

end; 

axis ( [0,6, 0,0.4] ) ; hold on; 
putf ill (yaw.bw , yaw.pd ,0,6, 0,0. 4, 3); 
putf ill (pit ch_bw , pitch.pd ,0,6, 0,0. 4,1); 
putf ill (roll.bw ,roll_pd , 0,6, 0,0. 4, 2) ; 

if exist ('COLOR') == 0, title('Spec 1 : Bawdwidth & Phase-delay ' ) ; 

else, titled 1 : BW vs. PD'); end; 

ind=''; if pitch^dist > delta, ind='*'; end; 

xtext([0,6] ,0.28, [*1 ' , ind] , '] ' ,mp) ; 

ind=''; if roll dist > delta, ind=’*'; end; 

xtext ( [0,6] ,0.20, [’2 ' , ind] , '] 9 ,mp) ; 

ind=''; if yaw_dist > delta, ind='*'; end; 

xtext ( [0,6] ,0. 12, [’3 ' , ind] , '] ' ,mp) ; 

ylabelO Phase delay [sec]’); xlabel (' Bandwidth [rad/sec]'); axis; 
if exist ( ’Title y ) , Tit=Title; else, Tit='UH-60 Hover performance'; end; 

if exist (' Iter ') , if Iter >= 0, 

Tit= [Tit , ' ; Completed ’ ,num2str (Iter) , ' C-0 iterations']; 
end ; end ; 
if exist('DeGr') , 

Tit= [Tit , 9 ; Design grade: 9 ,num2str (DeGr)] ; 
end; 

if exist ( 'Name' ) , 

Tit= [Tit , ' ; 9 ,Name] ; 

end; 

if exist ( 'Date' ) , 

Tit=[Tit , ' ; ’ ,Date] ; 

end; 

if exist ( 'COLOR' ) == 0, text (-2. 5, .5, Tit) ; end; 
hold off; 

7# Spec 2 
7. 

[Zeta,max_wn] = zeta(A,max([pitch_bw,roll_bw,yaw_bw])) ; 7. [ ] , [ ] 

if SPEC2 == 0, 

[mol ,pol]=bode(Aol,Bol ,Col ,Dol , 1 ,wo) ; 

[Gm,pitch_PM,Wg,pitch_Wco] = imargin(mol ,pol,wo) ; pitch_GM = 20*logl0(Gm) 
[mo2,po2] =bode (Ao2,Bo2 ,Co2 ,Do2 , 1 , wo) ; 

[Gm,roll_PM ,Wg,roll_Wco ] = imargin(mo2,po2,wo) ; roll_GM = 20*logl0(Gm) 
[mo3,po3] =bode(Ao3,Bo3,Co3,Do3, 1 ,wo) ; 

[Gm,yaw_PM ,Wg,yaw_Wco ] = imargin(mo3,po3,wo) ; yaw_GM = 20*logl0(Gm) 
end; 

subplot (342) ; 

f ill ( [6, 12, 12,6] , [45,45,90,90] , 'b' , . . . 
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[0,12,12,6,6,0] , [0,0,45,45,90,90] , ’r’) ; 
axis ( [0, 12 ,0,90] ) ; 

if exist ( ’COLOR’ ) == 0, title (’Spec 2 : Stability margins’); 

else, title(’2 : Stability margins ’) ; end; 

xlabel ( ’ GM [db] * ) ; ylabel(’PM [deg]’); hold on; 

putf ill(pitch_GM,pitch_PM,0, 12 ,0,90 , 1) ; 

putf ill (roll_GM ,roll_PM ,0,12,0,90,2); 

putf ill (yaw.GM ,yaw_PM ,0,12,0,90,3); 

ind=’’; if pitch.damp > delta, ind=’*’; end; 

xtext ( [0 , 12] , 63 , [ ’ 4 ’ , ind] , ’ ] * , mp) ; 

ind=’’; if roll_damp > delta, ind=’*’; end; 

xtext ( [0 , 12] , 45 , [ ’ 5 ’ , ind ] , ’ ] * , mp) ; 

ind=’’; if yaw.damp > delta, ind=’*’; end; 

xtext ( [0 , 12] , 27 , [ ’ 6 9 , ind ] , 9 ] 9 , mp) ; 

if exist ( ’COLOR’ ) == 0, 

text (-30,-30, [’Wco = ’ ,num2str (n2s(pitch_Wco,2)) , . . . 

’, ’ ,num2str (n2s (roll.Wco ,2)),... 

’, ’ ,num2str (n2s(yaw_Wco ,2)),’ [rad/sec]’]); 

text( 5,-30, [’Rrms = ’ ,num2str (n2s(sqrt (pitch_AE/5) ,2)) , . . . 

’ , ’ ,num2str (n2s(sqrt (roll_AE/5) ,2)) , . . . 

’, ’ ,num2str (n2s(sqrt (yaw.AE/5) ,2)),’ [in/sec]’]); 

text( 40,-30, [’Zeta = ’ ,mim2str (n2s(Zeta,2)) , ’ at 

num2str (n2s (max.wn , 2) ) , ’ [rad/ sec] ’ ] ) ; 

end; 

hold off; 

*/, Spec 3 

% 

if SPEC3 == 0, 
nR=l ; 


aR=Stet (1) ; 

drscd; 

Xll = X; 

aR=Stet (2) ; 

drscd; 

X12 = X; 

aR=Stet (3) ; 

drscd; 

X13 = X; 

nR=2; 

aR=Sphi(l) ; 

drscd; 

X21 * X; 

aR=Sphi(2) ; 

drscd; 

X22 = X; 

aR=Sphi(3) ; 

drscd; 

X23 = X; 

nR=3; 

aR=Spsi(l) ; 

drscmd : 

X31 = X 

aR=Spsi(2) ; 

dr scmd; 

X32 = X 

aR=Spsi(3) ; 

drscmd; 

X33 = X 


pitch_rl = max(Xll(: , 15) ) /Stet (1) ; '/, [1/sec] 

pitch_rls= pitch.rl-(0. 70+d3pl*LEVEL) ; 
pitch_r2 = max(X12( : , 15)) /Stet (2) ; 
pitch_r2s= pitch_r2-(0.40+d3p2*LEVEL) ; 
pitch_r3 = max(X13( : , 15) )/Stet (3) ; 
pitch_r3s= pitch_r3- (0 . 25+d3p3* LEVEL) ; 
roll.rl = min(X21( : , 14) )/Sphi(l) ; 
roll.rls = roll_rl-(1.39+d3rl*LEVEL); 
roll_r2 = min(X22( : , 14) ) /Sphi (2) ; 
roll.r2s = roll_r2-(0.85+d3r2*LEVEL) ; 
roll_r3 = min(X23( : , 14) ) /Sphi (3) ; 
roll r3s = roll.r3-(0 . 75+d3r3*LEVEL) ; 

yav. rl = max(X31(: , 16) )/X31 (length (t) ,6)/Kpsi; 

yaw. rls = yaw.rl- (1 .42+d3yl*LEVEL) ; # /A 

yaw_r2 = max(X32(: ,16))/X32(length(t) ,6)/Kpsi; %\ 

yaw_r2s = yaw_r2-(0.67+d3y2*LEVEL) ; '/* impulse ! 

yaw.r3 = max(X33(: , 16) ) /X33 (length (t) ,6)/Kpsi; */,/ 

yaw_r3s - yaw_r3-(0. 36+d3y3*LEVEL) ; '/,/ 

end; 
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Xps= [ 5 10 15 

Yps=[0.70 0.58 0.42 0 
Pp=polyf it (Xps , Yps , 2) 
Xrs= [ 10 20 30 

Yrs= [1 . 39 1.07 0.90 0 
Pr=polyf it (Xrs , Yrs ,2) 
Xys=[ 10 20 30 

Yys=[l .42 1.06 0.79 0 
Py=polyf it (Xys , Yys , 2) 
Ypsp=Yps+LEVEL* ([1.63 
Ppp=p°lyf it(Xps ,Ypsp, 
Yrsp=Yrs+LEVEL* ([2.35 
Prp=polyf it (Xrs , Yrsp , 
Yysp=Yys+LEVEL* ([2.40 
Pyp=p°lyf it (Xys , Yy sp , 
ly=length(Yp) ; 


20 25 30] 
.35 0.28 0.25] 

; Xpi=5: .25:30 
40 50 60] 
.80 0.75 0.70] 

; Xri=10 : .5:60 
40 50 60] 
.54 0.43 0.36] 

; Xyi=10: .5:60 


Yp=polyval(Pp,Xpi) ; 


Yr=polyval(Pr,Xri) ; 


Yy=polyval(Py,Xyi) ; 


1.42 1.25 1.10 1.00 0.93] -Yps) ; 
2); Ypp=polyval(Ppp,Xpi) ; 

1.85 1.50 1.21 0.98 0.80]-Yrs); 
2); Yrp=polyval(Prp,Xri) ; 

1.87 1.58 1.33 1.13 1.00]-Yys); 
2); Yyp=polyval(Pyp,Xyi) ; 


7. P 

subplot (343) ; 
if LEVEL == 0, 

filiao.Xpi.SS.SS.O] , [Yp(l) ,Yp,Yp(ly) ,2. 5, 2. 5] , 'b’ , . . . 
[O.Xpi, 35,35,0] , [Yp(l) ,Yp,Yp(ly) ,0,0] , ’r') ; 

6l S 6 

f ill( [0,Xpi,35,35,0] , CYpp(l) ,Ypp,Ypp(ly) ,2. 5, 2. 5] 

[0, Xpi ,35,35, Xpi(ly:-l:l) ,0] , . . . 

[Yp(l) , Yp.Ypdy) , Ypp(ly) ,Ypp(ly : -1 : 1) ,Ypp(l)] , ’b’ , . . . 
[0, Xpi, 35, 35,0] , [Yp(l) ,Yp, Yp(ly) ,0,0] ,’rO; 

end; 

if exist (’COLOR’) == 0, title(’Spec 3 : Quickness P’); 
else, title(’3 : Quickness P’); end; 

axis ([0,35,0,2.5]) ; hold on ; 

xlabel( ’Step(P) [deg] ’ ) ; ylabel( 7 max (q) /Step (P) [1/sec]’); 

putfill( 5,max(pitch_rl) ,0,35,0,2.5,1) ; 

putfill(17.5,max(pitch_r2) ,0,35,0,2.5,1); 

putf ill ( 30 ,max(pitch_r3) ,0,35,0,2.5,1); 

ind=’’; if pitch.rls < -delta, ind=’*’; end; 

xtext([0,35] ,1.75, [’7 \ind] , ’] ’ ,mp) ; 

ind =, ’j if pitch_r2s < -delta, ind= , * , j end; 

xtext([0,35] ,1.25, [>8 9 ,ind] , ’] J ,mp) ; 

ind= ,J ; if pitch_r3s < -delta, ind= , * J ; end; 

xtext ([0,35], 0.75, [ ’ 9 ’ , ind ] , 9 ] 9 , mp) ; 

hold off; 


X R 

subplot (344) ; 
if LEVEL == 0, 

fill ( [0 ,Xri , 70 , 70 ,0] , [Yr (1) , Yr ,Yr (ly) ,2. 5, 2. 5] , »b J , . . . 

[0,Xri ,70,70,60,50,0] , [Yr(l) ,Yr,Yr(ly) ,0.4,0.4,0.45,0.45] , >r* , . . . 
[0,50,60,70,70,0] , [0.45,0.45,0.4,0.4,0,0] , 9 m 9 ); 

fill([0,Xri,70,70,0] , [Yrp(l) ,Yrp,Yrp(ly) ,2. 5, 2. 5] , 9 c 9 , . . . 

[0,Xri ,70,70, Xri(ly:-1 : 1) ,0] , . . . 

[Yr(l) , Yr , Yr(ly) ,Yrp(ly) , Yrp(ly : -1 ; 1) ,Yrp(l)] , 9 b 9 , . . . 

[0,Xri, 70, 70, 60,50,0] , [Yr(l) ,Yr,Yr(ly) ,0.4,0.4,0.45,0.45] , 9 t 9 , . . . 
[0,50,60,70,70,0] ,[0.45,0.45,0.4,0.4,0,0] , 9 m 9 )\ 

end; 

if exist ('COLOR') — 0, title( , Spec 3 : Quickness RO; 
else, title( J 3 : Quickness K 9 ); end; 

axis( [0,70,0,2. 5] ) ; hold on; 

xlabel( ’Step^R) [deg] 9 ) ; ylabel( ’max (p) /Step (R) [1/sec]’); 
putf ill (10,max(roll_rl) , 0, 70,0, 2 . 5 , 2) ; 
putf ill(35,max(roll_r2) ,0,70,0 ,2 . 5,2) ; 
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end; 

end; 

end; 


putf ill (60 ,max(roll_r3) ,0,70,0,2.5,2) 
ind=’’; if roll^rls < -delta, ind=’*’ 
xtext ( [0 , 70] , 1 . 75 , [ ’ 10 ’ , ind] , ’ ] ’ ,mp) 
ind=’’; if roll_r2s < -delta, ind=’*’ 
xtext ([0,70] ,1.25, [’ll ’ , ind] , ’] ’ ,mp) 
ind=’’: if roll_r3s < -delta, ind=’*’ 
xtext ( [0,70] ,0.75, [’ 12 9 , ind] , ’] ’ ,mp) 
hold off; 

7 . Y 

subplot (345) ; 
if LEVEL == 0, 
f ill( [0,Xyi ,70,70,0] , [Yy(l) ,Yy,Yy(ly) ,2. 5, 2. 5] , ’b’ , . . . 

[0,Xyi, 70,70,60, 10,0] , [Yy(l) ,Yy,Yy(ly) ,0. 17,0. 17,0.417 ,0 .417] , ’r' , . . . 
[0,10,60,70,70,0] ,[0.417,0.417,0.17,0.17,0,0] 

else 

f ill( [0,Xyi,70,70,0] , [Yyp(l) ,Yyp,Yyp(ly) ,2. 5, 2. 5] , ’c’ , . . . 
[0,Xyi,70,70,Xyi(ly:-l: 1) ,0] , . . . 

[Yy (1) , Yy , Yy(ly) ,Yyp(ly) ,Yyp(ly:-l : 1) ,Yyp(l)] , ’b’ , . . . 

[0,Xyi ,70,70,60, 10,0] , [Yy(l) ,Yy,Yy(ly) ,0.17,0.17,0.417,0.417] , ’r’ , . . . 
[0, 10, 60, 70, 70,0], [0.417, 0.417, 0.17,0. 17, 0,0],'m'); 

end; 

if exist (’COLOR’) == 0, title(’Spec 3 : Quickness Y’); 
else, title (’3 : Quickness Y’); end; 

axis([0,70,0,2.5]) ; hold on; 

xlabel( ’Step(Y) [deg]’); ylabel( ’max(r) /Step(Y) [1/sec]’); 

putf ill(10,max(yaw_rl) ,0 ,70 , 0 ,2 . 5 ,3) ; 

putf ill(35,max(yaw_r2) ,0,70,0,2. 5,3) ; 

putf ill(60,max(yaw_r3) ,0,70,0,2.5,3) ; 

ind=’’; if yaw_rls < -delta, ind=’*’; end; 

xtext([0,70] ,1.75, [’13 ’ ,ind] , ’] ’ ,mp) ; 

ind=’’; if yaw_r2s < -delta, ind=’*’; end; 

xtext ( [0,70] ,1.25, [’14 ’ ,ind] , ’] ’ ,mp) ; 

ind=’’; if yaw_r3s < -delta, ind=’*’; end; 

xtext ( [0,70] ,0 .75 , [’ 15 ’ ,ind] , ’] ’ ,mp) ; 

hold off; 

7 * Spec 4 


if SPEC4 == 0, 

nR=4 ; aR=Scol ; drscd; X41 = X; 

pitch.d = X23(l : 121 , 18) /Sphi (3) ; 7 . [ ] 

roll d = X 13(1 : 121 , 17)/Stet (3) ; 

yaw dl ■ 180/pi*X41(t3 :nt , 16) ; 7. [deg/sec] 

Mrl = max(X41(: ,16)); Jrl = f ind(X41 ( : , 16) == Mrl) ; 7. for w(t) < 0 

if t (Jrl) >= t3, rl = X41(tl,16); else, rl = Mrl; end; 7 . and r(t) > 0 
r3 = X41 (t3 , 16) -rl ; 
yy = ~180/pi*rl/X41(t3, 13) ; 
x y = 180/pi*r3/X41(t3, 13) ; 

a_y = (x_y-0. 15) "2; b_y = (y.y-0 .65) "2; c_y = (x_y+0.2)~2; 
if (x_y >= 0.15) k (y_y < 0.65), 

yaw_d2 = a_y; 

elseif (x_y < -0.2) & (y_y < 0.65), 

yaw_d2 = c_y; 

elseif (x_y >= -0.2) k (x_y < 0.15) k (y_y >= 0.65), 

yaw_d2 = b_y ; 

elseif (x_y >= 0.15) k (y_y >= 0.65), 
yaw_d2 = a_y + b_y; 
elseif (x_y < -0.2) k (y_y >= 0.65), 

yaw_d2 = b_y + c_y; 
else, 

yaw_d2 = 0; 
end; 
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end; 


7. P/R 

subplot (346) ; 

f ill( [0,4,4,0] , [-.25, -.25, .25 ,.25 

(0,4,4,0],[ .25, .25, .60 ,.60 ],’r\... 

[0,4,4,0] , C .60, .60, .75 ,.75 ],’m\... 

[0,4, 4,0] , [-.60, -.60, -.25, -.25] , ’ r ’ , . . . 

[0,4, 4,0] , [-.75, -.75, -.60, -.60] , ’m’) ; 
bold on; 

plot(t(l : 121) ,pitch_d, ’y’) ; axis([0,4,-.75, .75]) ; hold off; 
if exist ( ’COLOR’ ) == 0, title (’Spec 4 : Coupling P/R’); 
else, title(’4 : Coupling P/R’); end; 

xlabel(’time [sec]’); ylabel( ’P/Step (R) ’); 
ind=’’; if max(abs(pitch_d)) > 0.25+delta, ind=’*’; end; 
xtext ( [0,4] ,0 , [ ’ 16 ’ , ind] , ’] ’ ,mp) ; 

7. R/P 

subplot (347) ; 

f ill ( [0 , 4 , 4 , 0] , [- . 25 , - . 25 , .25 ,.25 ],’b’,... 

[0,4, 4,0] , [ .25, .25, .60 , .60 ] , ’r’ , . . . 

[0,4,4,0] , [ .60, .60,-75 ,.75 ],’m’,... 

[0,4, 4,0] , [-.60, -.60, -.25, -.25] , ’r’ , . . . 

[0,4, 4,0] , [-.75, -.75, -.60, -.60] ,’m’); 
hold on; 

plot (t(l: 121) ,roll_d, ’g’) ; axis ( [0,4,- .75, .75] ) ; hold off; 
if exist (’COLOR’) == 0, title(’Spec 4 : Coupling R/P’); 
else, title(’4 : Coupling R/P’); end; 

xlabel(’time [sec]’); ylabel( ’R/Step(P) ’); 
ind=’’; if max(abs(roll_d)) > 0.25+delta, ind=’*’; end; 
xtext ([0,4] ,0, [’17’ , ind] , ’] ’ ,mp) ; 

7. Y/C 

subplot (348) ; 

fill([-l. ,-.70, -.70, .7,. 7,1. ,1. ,-l.] , [0,0, .90, .90,0,0,1. ,1.] , ’m’ , . . . 

[-. 7, -.15, -.15,. 2,. 2,. 7,. 7, -.7], [0,0,. 65,. 65, 0,0,. 9,. 9], ’r’,... 

[-.15, .2, .2,-. 15] , [0, 0,.65,. 65], ’b’); axis( [-1 , 1 ,0, 1] ) ; hold on; 
if exist (’COLOR’) == 0, title (’Spec 4 : Coupling Y/C a’); 
else, title(’4 : Coupling Y/C a’); end; 

putf ill(-x_y ,y_y ,-l , 1,0, 1,3) ; 

xlabel ( ’ r3/ I w (3) I [deg/ft]’); ylabel(’ |rl/w(3) I [deg/ft]’); hold of f ; 
ind=”; if yaw_d2 > delta, ind=’*’; end; xtext([-l,l] ,0.5, [’18 ’ , ind] , ’] ’ ,mp) 
subplot (349) ; t3_5=3:dt:5; 

f ill( [3, 5, 5, 3] , [-5 ,-5 ,5 ,5 ], ’b’ , [3,5, 5,3] , [5,5,10,10] , ’r' ... . 

[3, 5, 5, 3], [-10, -10, -5, -5], ’r’); hold on; 
plot(t3_5,yaw_dl, ’w’) ; axis( [3, 5, -10, 10] ) ; hold off; 
if exist (’COLOR’) == 0, title(’Spec 4 : Coupling Y/C b’); 
else, title(’4 : Coupling Y/C b’); end; 

xlabel (’time [sec]’); ylabel(’r [deg/sec]’); 
ind=’’; if max(abs(yaw_dl)) > 5+delta, ind=’*’; end; 
xtext([3,5] ,0, [’19 ’ ,ind] , ’] ’ ,mp) ; 
if exist ( ’COLOR’ ) == 0, 

text (2. 5, -15, ’level 1 - blue’); 

if LEVEL > 0, text (5, -15, 'level 1+ - cyan ’); end; 
text(10, -15, ’pitch - yellow’); 
text (2. 5, -17, ’level 2 - red’); 
text (10, -17, ’roll -green’); 
text (2. 5, -19, ’level 3 - magenta’); 
text(10,-19, ’yaw - white’); 
end; 

'/. Spec 5 

7 . 





if SPEC5 == 0, 

[Age , Bgc , Cgc , Dgc] =ser ies ( Ag , Bg , Cg ,Dg , Ac , Bgg , Co , Do) ; 

[ygl ,x] = step (Age, Bgc (: ,1) ,Cgc(l, :) ,Dgc(l,l) ,l,tg) ; 
pitch_up=x( : ,8 ); pitch_ur=K(l)*(x( : ,8 )-x(:,15)); 

[yg2 , x] = step (Age , Bgc ( : ,2) ,Cgc(2, : ) , Dgc (2, 2) ,1 ,tg) ; 
roll_up =x(:,10); roll_ur =K(2)*(x(: , 10)-x(: ,16)) ; 

[yg3,x] = step(Agc,Bgc( : ,3) ,Cgc(3, : ) ,Dgc(3,3) ,l,tg) ; 
yaw.up =x(:,12); yaw_ur =K(3) *(x( : , 12) -x( : , 17)) ; 
pitch.g = 180/pi*ygl; '/. [deg] 

roll_g = 180/pi*yg2; 
yaw_g = 180/pi*yg3; 
end; 

Xr=[0, 10, 10,40,40,0] ; Xb*[0, 10, 10,40,40, 10, 10,0] ; 

% P 

subplot (3,4, 10) ; 

fill(Xr, [4, 4, 0.4, 0.4, 5, 5] , 7 r 7 ,Xr, [-4, -4, -0.4, -0.4, -5, -5] , 7 r 7 , . . . 

Xb, [-4, -4, -0.4, -0.4, 0.4, 0.4, 4,4] , 7 b 7 ) ; hold on; 
plot (tg,pitch_g, 7 y 7 ) ; axis( [0,40, -5,5] ) ; 
if exist ( 7 COLOR 7 ) == 0, title ( 7 Spec 5 : Wind-Gust P 7 ); 
else, titled : Wind-Gust P 7 ); end; 

xlabel( 7 time [sec] 7 ); ylabel( 7 P [deg] 7 ); hold of f ; 
ind= 77 ; if max(abs(pitch_g(l:n!0))) > 4+delta, ind= 7 * 7 ; end; 
xtext ( [0,40] , 1 , [ 7 20 7 , ind] , 7 ] 7 ,mp) ; 

ind= 77 ; if max(abs(pitch_g(nl0+l :nfg) )) > 0. 4+delta, ind= 7 * 7 ; end 
xtext ( [0,40] ,-l, [ 7 21 7 , ind] , 7 ] 7 ,mp) ; 
if max(pitch_up) > Csu(l) I ... 

min(pitch_up) < Csl(l) | max(abs(pitch_ur)) > abs(Rsl(l)), 
satp= 7 Saturated 7 ; 
else, satp= 77 ; end; 
text (11 , 1 . 5,satp) ; 

% R 

subplot (3 ,4, 11) ; roll_g; 

fill(Xr, [4, 4, 0.4, 0.4 ,5, 5] , 7 r 7 ,Xr, [-4, -4, -0.4, -0.4, -5, -5] , 7 r 7 , . . . 

Xb, [-4, -4, -0.4, -0.4, 0.4, 0.4, 4, 4] , 7 b 7 ) ; hold on; 
plot (tg,roll_g, 7 g 7 ) ; axis ([0,40, -5, 5]) ; 
if exist ( 7 COLOR 7 ) == 0, title( 7 Spec 5 : Wind-Gust R 7 ); 
else, title( 7 5 : Wind-Gust R 7 ); end; 

xlabel( 7 time [sec] 7 ); ylabel( 7 R [deg] 7 ); hold off; 
ind= 77 ; if max(abs(roll_g(l :nl0)) ) > 4+delta, ind= 7 * 7 ; end; 
xtext( [0,40] ,1, [ 7 22 7 ,ind] , 7 ] 7 ,mp) ; 

ind= 77 ; if max(abs(roll_g(nl0+l :nfg)) ) > 0. 4+delta, ind= 7 * 7 ; end; 
xtext ( [0,40] ,-l, [ 7 23 7 ,ind] , 7 ] 7 ,mp) ; 
if maLx(roll_up) > Csu(2) I ... 

min(roll_up) < Csl(2) I max(abs(roll_ur)) > abs(Rsl(2)), 
satr= 7 Saturated 7 ; 
else, satr= 77 ; end; 
text (11,1.5, satr) ; 

% Y 

subplot (3,4, 12) ; 

fill(Xr, [4, 4, 0.4, 0.4, 5, 5] , 7 r 7 ,Xr , [-4, -4, -0.4, -0.4, -5, -5] , 7 r 7 , . . . 

Xb, [-4, -4, -0.4, -0.4, 0.4,0 .4,4,4] , 7 b 7 ) ; hold on; 
plot (tg,yaw_g, 7 w 7 ) ; axis ( [0,40, -5, 5]) ; 
if exist ( 7 COLOR 7 ) == 0, title( 7 Spec 5 ; Wind-Gust Y 7 ); 
else, title( 7 5 : Wind-Gust Y 7 ); end; 

xlabel( 7 time [sec] 7 ); ylabel( 7 Y [deg] 7 ); hold off; 
ind= 7 7 ; if max(abs(yaw_g(l :nl0)) ) > 4+delta, ind= 7 * 7 ; end; 
xtext ( [0,40] ,1, [ 7 24 7 ,ind] , 7 ] 7 ,mp) ; 

ind= 77 ; if max(abs(yaw_g(nl0+l :nfg)) ) > 0. 4+delta, ind= 7 * 7 ; end; 
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xtext( [0,40] ,-l,[’25 ’ ,ind] , ’] ’ ,mp) ; 
if max(yaw_up) > Csu(3) I ... 

min(yaw_up) < Csl(3) I max(abs(yaw_ur)) > abs(Rsl(3)), 
saty= ’ Saturated ’ ; 
else, saty=’’; end; 
text (11,1.5, saty ) ; 

axis (’normal’) ; 


attitude, m - Attitude response 


•/. MATLAB M-file (SCRIPT ! ! !) for ATTITUDE CHANGE DISPLAY 

*/. 

'/. Gil Yudilevitch ISR 02-20-94 

*/. 

l=length(t) ; 

0=ones(l,l) ; 

figure(l); elf ; 

subplot(3,3,l) ; nplot(t , [Xll( : , 18)/DtR,5*0 ] ,2) ; 

ylabel( ’Small’ ) ; title ( ’Pitch’ ) ; rtext (-0.2,5, ’5’) ; f text (-2, 2, ’Small’) ; 

subplot (3,3,4); nplot (t , [X12 ( : , 18) /DtR , 17 . 5*0] , 2) ; 

ylabel (’ Medium’ ) ; rtext(-0.2,17.5, ’17.5’) ; ftext(-2,10, ’Medium’) ; 

subplot (3, 3, 7) ; nplot (t , [X13( :, 18) /DtR, 30*0 ],2); 

ylabel( ’Large’ ) ; rtext(-0.2,30, ’30’) ; ftext(-2, 15, ’Large’) ; 

Mn=min(min(Url3( : ,1))) ; Mx=max(max(Url3( : ,1))) ; 

subplot (3, 3, 2) ; nplot(t, [X21(: ,17)/DtR,-10*0] ,2) ; title( ’Roll ’ ) ; 
subplot (3, 3, 5) ; nplot(t, [X22(: , 17) /DtR, -35*0] ,2) ; 
subplot (3, 3, 8) ; nplot(t, [X23(: ,17) /DtR, -60*0] ,2) ; 

subplot (3, 3, 3) ; nplot (t , [X31 ( : , 19) /DtR, 10*0] ,2) ; title( ’Yaw’ ) ; 
rtext (-0 . 2 , 10 , ’ 10 ’ ) ; 

subplot (3,3,6); nplot (t , [X32 ( : , 19) /DtR , 35*0] , 2) ; 
rtext (-0 .2,35, ’ 35 ’ ) ; 

subplot (3, 3, 9) ; nplot (t , [X33( : , 19) /DtR, 60*0] ,2) ; 
rtext (-0 . 2 , 60 , ’ 60 ’ ) ; 


actuator, m - Actuator rates and strokes 
*/. MATLAB M-file (SCRIPT !!!) for ACTUATOR RATES ft STROKES DISPLAY 

7 . 

*/. Gil Yudilevitch ISR 02-20-94 

’/. 

figure (1) ; elf; 

subplot (3, 4,1 ); nplot(t,Urll(: ,1) ,2) ; title( ’Pitch’ ) ; ftext (-2,0, ’Small’) ; 
subplot (3, 4, 5 ); nplot (t,Url2(: ,1) ,2) ; f text (-2,-5, ’Medium’ ) ; 
subplot (3,4,9 ); nplot(t ,Url3( : , 1) ,2) ; f text (-2, -5, ’Large’) ; 

Mn=min(min(Url3( : ,1))) ; Mx=max(max(Url3(: ,1))) ; 
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subplot (3 ,4, 2 ); nplot(t ,Ur21( : ,2) ,2) ; title( ’Roll’ ) ; 
subplot (3 ,4 ,6 ); nplot (t ,Ur22( : ,2) ,2) ; 
subplot (3,4, 10) ; nplot (t ,Ur23( : ,2) ,2) ; 

subplot (3,4,3 ); nplot(t ,Ur31( : ,3) ,2) ; title( ’ Yaw' ) ; 
subplot (3 ,4,7 ); nplot (t ,Ur32( : ,3) ,2) ; 
subplot (3,4,11); nplot (t ,Ur33( : ,3) ,2) ; 

subplot (3,4,4 ) ; nplot (t ,Ur41( : ,4) ,2) ; title( ’Collective’ ) ; 
Title = ’Actuators Strokes’; 
figure (2); elf ; 

subplot (3,4,1 ); nplot (t ,Usll ( : , 1) , 2) ; f text (-2, -0.5, ’Small’) 
subplot (3, 4,5 ) ; nplot (t ,Usl2( : , 1) ,2) ; f text (-2, -1 . 8, ’Medium’ 
subplot (3, 4,9 ) ; nplot (t ,Usl3( : , 1) ,2) ; ftext (-2, -2. 5, ’Large’) 

Mn=min(min(Usl3( : , 1))) ; Mx=max(max(Usl3( : , 1))) ; 

subplot (3,4,2 ); nplot (t ,Us21 ( : ,2) ,2) ; title( ’Roll’ ) ; 
subplot (3,4,6 ); nplot (t ,Us22( : ,2) ,2) ; 
subplot (3 ,4 , 10) ; nplot (t ,Us23 ( : , 2) , 2) ; 

subplot (3,4,3 ); nplot (t ,Us31 ( : ,3) , 2) ; title( ’ Yaw’ ) ; 
subplot (3 ,4 ,7 ); nplot (t ,Us32( : ,3) ,2) ; 


title( ’Pitch’ ) ; 
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B A tutorial example 


In the following design example the initial controller is the final ADOCS design of [18], 
with the crossfeed gains K rp , K pr and K cy initially set to zero. The final design is the 
nominal optimal design (see Section 5). Two changes are implemented in this example. 
First, a correct “broken-loop” scheme of Figure 4.3 is used (see Remark 4.3). Second, 
updated (75 ms) time delays for all channels are used. This final optimal design has 
better “damping” characteristics than the design of Section 5. 

The tutorial example is a complete “record” of the screen (except some unnecessary 
messages). In addition some comments are given following the % sign. They are not 
generated by the computer during the design process. 


'/, The following tap command only works in the GLUE (UMCP) system 

archimedes : / software/control/ adocs/pjpotter/adocs/ convert : tap console 

*/, Convert the adocs file (which includes dp. adocs . f in) to adocs.o and adocs.d 
*/, files for use by Solve 

archimedes : /sof tware/control/adocs/pjpotter/adocs/convert : convert adocs 

Welcome to CONSOL-OPTCAD (TM) 

CONVERT Version 1.2 (Released 5/92) 

Copyright (c) 1991, University of Maryland at College Park. 

All Rights Reserved. 

(developed by Michael K.H. Fan, Andre L. Tits, 

Jian L. Zhou, Li-Sheng Wang and Jan Koninckx) 

[processing adocs] 

[processing dp.adocs] 

[processing adocs .dp. fin] 
design parameter Ktet is set to 10.40000 
design parameter Kphi is set to 8.40000 
design parameter Kpsi is set to 7.60000 
design parameter Kq is set to 6.80000 
design parameter Kp is set to 1.30000 
design parameter Kr is set to 4.00000 
design parameter Mtet is set to 2.00000 
design parameter Mphi is set to 2.50000 
design parameter Mpsi is set to 2.00000 
design parameter Kr_p is set to 0.00000 
design parameter Kp_r is set to 0.00000 
design parameter Kc_y is set to 0.00000 
[processing stable. all] 

[processing object. sat] 

[processing sped. pit] 

[processing specl.rol] 

[processing sped. yaw] 

[processing spec2.pit] 

[processing spec2.rol] 
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[processing spec2.yaw] 
[processing spec3.pit] 
[processing spec3.rol] 
[processing spec3.yaw] 
[processing spec4.pit] 
[processing spec4.rol] 
[processing spec4.yaw] 
[processing spec5.pit] 
[processing spec5.rol] 


[processing specS.yaw] 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
warning: design parameter 
[compiling adocs.c] 
[writing adocs.d] 


Kpsi never used 
Ktet never used 
Mpsi never used 
Mtet never used 
Kp never used 
Kq never used 
Kr never used 
Kc_y never used 
Kp_r never used 
Kr_p never used 
Kphi never used 
Mphi never used 


V, After copying adocs.d and adocs.o files to working solve directory, 

’/, change path to that directory and initiate the Solve command 

archimedes:/software/control/adocs/pjpotter/adocs/convert : cd . ./solve/1 
archimedes: /software/control/adocs/pjpotter/adocs/solve/1: solve -matlab adocs 


Welcome to CONSOL-OPTCAD (TM) 
SOLVE Version 1.7 (Released 8/92) 


Copyright (c) 1991, University of Maryland at College Park. 
All Rights Reserved. 

(developed by Michael K.H. Fan, Andre L. Tits, 

Jian L. Zhou, Li-Sheng Wang and Jan Koninckx) 

[loading/reading adocs.o and ...] 

[reading adocs.d] 

[calling simulator initialization (if any)] 

[connecting to MATLAB engine . . .] 

[including file init.m ...] 

[calling problem initialization (if any)] 

type "help" for help 

type "help info" for information 

•/, Identify command to identify the optimization problem 

<0> identify 
PROBLEM: adocs 
12 Design Parameter (s) 

3 Objective(s) 

20 Constraint (s) 

18 Functional Constraint (s) 

*/, Print command to ensure correct initial design parameters 
*/, (dp’s) were included 

<0> print 

Name Value Variation wrt 0 Prev lter=0 
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Ktet 

1 . 04000e+01 

1.0e+00 

Kphi 

8 . 40000e+00 

1.0e+00 

Kpsi 

7. 60000e+00 

1 . 0e+00 

Kq 

6 . 80000e+00 

1.0e+00 

Kp 

1 . 30000e+00 

1.0e+00 

Kr 

4 . 00000e+00 

1.0e+00 

Mtet 

2 . 00000e+00 

1.0e+00 

Mphi 

2 . 50000e+00 

1.0e+00 

Mpsi 

2.00000e+00 

1.0e+00 

Kr_p 

0 . 00000e+00 

1.0e+00 

Kp_r 

0 . 00000e+00 

1.0e+00 

Kc_y 

0.00000e+00 

1.0e+00 


V, Pcomb command to get an initial look at the 
V, feasibility problem (note Phase 2) 

<0> pcomb 

Pcomb (Iter= 0) (Phase 2) (MAX_C0ST_S0FT= 48.0187) 


SPECIFICATION 

01 p_act_rate 

02 r.act.rate 

03 y_act_rate 

Cl stable all 
C2 pit bw pd 

C3 pit Td 

C4 rol bw pd 

C5 rol Td 

C6 yaw bw pd 

C7 yaw Td 

C8 pit damp 

C9 rol damp 

CIO yaw damp 

Cll pit quickl 
C12 pit quick2 
C13 pit quick3 
C14 rol quickl 
C15 rol quick2 
C16 rol quick3 
C17 yaw quickl 
C18 yaw quick2 
C19 yaw quick3 
C20 yaw dec2 d 
FC1 pit dec up 
FC2 pit dec lo 
FC3 rol dec up 
FC4 rol dec lo 
FC5 yaw decl u 
FC6 yaw decl 1 
FC7 p gust p u 
FC8 p gust p 1 
FC9 p gust t u 
FC10 p gust t 1 
FC11 r gust p u 
FC12 r gust p 1 
FC13 r gust t u 
FC14 r gust t 1 
FC15 y gust p u 
FC16 y gust p 1 
FC17 y gust t u 
FC18 y gust t 1 


PRESENT 

GOOD 


-9.19e+01 

0 . 00e+00 

< = = 

-9 . 60e+01 

0.00e+00 

< = = 

-6 . 53e+01 

0.00e+00 

< = = 

-6 . 04e-02 

0.00e+00 

< — 

0.00e+00 

0.00e+00 

===: 

-2 . 36e-01 

0.00e+00 

< 

0 . 00e+00 

0 . 00e+00 

===: 

-2.70e-01 

0 . 00e+00 

< 

0.00e+00 

0.00e+00 

===: 

-3. 56e-01 

0.00e+00 

< 

2.72e-03 

0 . 00e+00 

=== 

0.00e+00 

0 . 00e+00 

=== 

6 . 68e-03 

0 . 00e+00 

=== 

4 . 24e-01 

0.00e+00 

<== 

6 . 26e-01 

0.00e+00 

<== 

6 . 07e-01 

0.00e+00 

<== 

-6 . 72e-01 

0.00e+00 


-2 . 54e-01 

0.00e+00 


-2 . 53e-01 

0 . 00e+00 


8 . 31e-01 

0.00e+00 

<== 

5.42e-01 

0.00e+00 

<== 

5 . 60e-01 

0.00e+00 

<== 

3 . 31e-03 

0.00e+00 

=== 

-1 . 94e-01 

0.00e+00 

<== 

2 . 50e-01 

0.00e+00 

<==: 

-2 ,40e-01 

0.00e+00 

<== 

2 . 64e-02 

0.00e+00 


-4 . 01e+00 

0 . 00e+00 

<== 

3 . 82e+00 

0 . 00e+00 

< ==: 

-2 . 22e+00 

0 . 00e+00 

< = = 

3 . 92e+00 

0 . 00e+00 

< ==: 

-4.47e-01 

0 . 00e+00 

< = = 

3 . 10e-01 

0 . 00e+00 

<==: 

-2.92e-01 

0 . 00e+00 

♦ 

3.57e+00 

0 . 00e+00 

<==: 

-4.25e-01 

0 . 00e+00 

<== 

-1 .61e-03 

0 . 00e+00 


-3.06e+00 

0 . 00e+00 

<== 

3.96e+00 

0 . 00e+00 

<==: 

-4.36e-01 

0 . 00e+00 

<== 

3.31e-01 

0 . 00e+00 

<==: 


G 

I 

I 


B 

I 

I 

I 

I 

I 

I 

I 

I 


I 


<====================== 

<***=================== 

I I 

I I 

i i 


============================* 


i i 

*==========—====== 


<====================== 

I I 


l*> 


BAD 

1.00e+00 
1.00e+00 
1 . 00e+00 
1.00e-03 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1 . 00e-04 
========> 1.00e-03 

1.00e-03 
========> l.00e-03 

========= -6 . 00e-02 

========= -4 . 00e-02 

========= -3 . 00e-02 

==> -1 . 40e-02 
==> -8 . 00e-02 
==> -7 . 00e-02 
========= -1.00e-01 

========= -7 . 00e-02 

========= -4 . 00e-02 

2 . 00e-03 
5 . 00e-02 
======== -5 .00e-02 

5 . 00e-02 
======== -5 . 00e-02 

5 . 00e-01 
======== -5 . 00e-01 

3 . 00e-01 
======== -3 . 00e-01 

3 . 00e-02 
======== -3 . 00e-02 

3 . 00e-01 
======== -3 . 00e-01 

3 . 00e-02 
======== -3 . 00e-02 

3 . 00e-01 
======== -3.00e-01 

3 . 00e-02 
======== -3 . 00e-02 


•/, Sim command, connects to MATLAB to allow graphical interpretation of pcomb 
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<0> sim 

Enter HATLAB, type ’back’ to leave 

» specs 

>> prspecs 

» print 

» back 

back to SOLVE 

*/, Run command, run 2 iterations of the feasibility problem 
<0> run 2 
<2> print 

Name Value Variation wrt 0 Prev Iter=2 

Ktet 1 . 02668e+01 1.0e+00 -17. 07. 

Kphi 8. 85963e+00 1.0e+00 57. 17. 

Kpsi 7.48843e+00 1.0e+00 -17. 07. 

Kq 6 . 86021e+00 1.0e+00 07. 07. 

Kp 1 . 78719e+00 1.0e+00 377, 47. 

Kr 4 . 25991e+00 1.0e+00 67. 07. 

Mtet 1 . 99901e+00 1.0e+00 07. 07. 

Mphi 4 . 75462e+00 1.0e+00 907. 67. 

Mpsi 2 .00000e+00 1.0e+00 07. 07. 

Kr p 9 . 58741e-02 1.0e+00 ****7. -14427. 

Kp_r -3 . 38780e-01 1.0e+00 ****7. 507. 

Kc_y -5 . 40903e-03 1.0e+00 ****7, ****7. 

<2> pcomb 

Pcomb (Iter= 2) (Phase 2) (MAX_C0ST_S0FT= 1.93252) 

BAD 

1.00e+00 
1.00e+00 
1.00e+00 
1.00e-03 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
1.00e-03 
1.00e-03 
1.00e-03 
6. 00e-02 
4. 00e-02 
3 . 00e-02 
1.40e-02 
8. 00e-02 
7 . 00e-02 
1.00e-01 
7 . 00e-02 
4 . 00e-02 
2 . 00e-03 
5 . 00e-02 
5 . 00e-02 
5 . 00e-02 
5 . 00e-02 
5 . 00e-01 
5 . 00e-01 
3. 00e-01 
3 . 00e-01 


SPECIFICATION PRESENT GOOD 

01 p_act_rate -9.19e+01 0.00e+00 

02 r_act_rate -7.35e+01 0.00e+00 

03 y_act_rate -6.53e+01 0.00e+00 

Cl stable all -4.43e-02 0.00e+00 

C2 pit bw pd 0.00e+00 0.00e+00 

C3 pit Td -2 . 30e-01 0.00e+00 

C4 rol bw pd 0.00e+00 0.00e+00 

C5 rol Td -2 . 85e-01 0.00e+00 

C6 yaw bw pd 0.00e+00 0.00e+00 

C7 yaw Td -3.56e-01 0.00e+00 

C8 pit damp 1.93e-03 0.00e+00 

C9 rol damp 0.00e+00 0.00e+00 

CIO yaw damp 1.34e-03 0.00e+00 

Cll pit quickl 4.34e-01 0.00e+00 

C12 pit quick2 6.33e-01 0.00e+00 

C13 pit quick3 6.11e-01 0.00e+00 

C14 rol quickl 4.20e-02 0.00e+00 

C15 rol quick2 3.00e-01 0.00e+00 

C16 rol quick3 -5.72e-02 0.00e+00 

C17 yaw quickl 8.23e-01 0.00e+00 

C18 yaw quick2 5.39e-01 0.00e+00 

C19 yaw quick3 5.59e-01 0.00e+00 

C20 yaw dec2 d 1.78e-03 0.00e+00 

FC1 pit dec up -1.68e-01 0.00e+00 

FC2 pit dec lo 2.50e-01 0.00e+00 

FC3 rol dec up -2.50e-01 0.00e+00 

FC4 rol dec lo 3.48e-02 0.00e+00 

FC5 yaw decl u -4.14e+00 0.00e+00 

FC6 yaw decl 1 4.20e+00 0.00e+00 

FC7 p gust p u -2.22e+00 0.00e+00 

FC8 p gust p 1 3.97e+00 0.00e+00 


G B 



< 
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FC9 p gust t u -4.28e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2.98e-01 O.OOe+OO <================================ -3.00e-02 

FC11 r gust p u -6.91e-01 O.OOe+OO <== I I 3.00e-01 

FC12 r gust p 1 3 . 74e+00 O.OOe+OO <================================ -3 . OOe-Ol 

FC13 r gust t u -4.57e-01 O.OOe+OO <== I I 3.00e-02 

FC14 r gust t 1 1 . 44e-01 O.OOe+OO <================================ -3.00e-02 

FC15 y gust p u -3.07e+00 O.OOe+OO <== I I 3.00e-01 

FC16 y gust p 1 3 . 97e+00 O.OOe+OO <======“============“========== -3 . 00e-01 

FC17 y gust t u -4.30e-01 O.OOe+OO <== I I 3.00e-02 

FC18 y gust t 1 3 . 17e-01 O.OOe+OO <================================ -3.00e-02 


<2> sim 

Enter MATLAB, type ’back* to leave 

>> specs 

>> prspecs 

>> print 

>> back 

back to SOLVE 

•/. Still in Phase 2, run 2 more iterations 
<2> run 2 


<4> print 


Name 

Value 

VaLriation 

wrt 0 

Prev 

Ktet 

9 . 84782e+00 

1.0e+00 

-57. 

-27. 

Kphi 

9 . 18396e+00 

1.0e+00 

97. 

27. 

Kpsi 

7 . 38528e+00 

1.0e+00 

-27. 

07. 

Kq 

7 . 05046e+00 

1.0e+00 

37. 

17. 

Kp 

2. 17128e+00 

1 . 0e+00 

677. 

117. 

Kr 

4 . 48474e+00 

1.0e+00 

127. 

27. 

Mtet 

1 . 99720e+00 

1.0e+00 

07. 

07. 

Mphi 

5 . 87986e+00 

1.0e+00 

1357. 

127. 

Mpsi 

2 . 00000e+00 

1.0e+00 

07. 

07. 

Kr_p 

6 . 68756e-02 

1.0e+00 

****7. 

777. 

Kp_r 

-3 . 21602e-01 

1.0e+00 

****'/, 

107. 

Kc_y 

-6.54780e-02 

1.0e+00 

****'/, 

717. 


<4> pcomb 


Pcomb (Iter= 4) (Phase 2) (MAX_C0ST_S0FT= 0.0666746) 


SPECIFICATION 

PRESENT 

GOOD 


G 

B 

BAD 

01 

p_act_rate 

-9 . 19e+01 

O.OOe+OO 

< = = 

i 

i 

1. 00e+00 

02 

r act rate 

-6.26e+01 

0 . 00e+00 

< = = 

i 

i 

1. 00e+00 

03 

y_act_rate 

-6.49e+01 

0 . 00e+00 

< = = 

i 

i 

1. 00e+00 

Cl 

stable all 

-4.52e-02 

0 . 00e+00 

< 

i 

i 

1.00e-03 

C2 

pit bw pd 

0.00e+00 

O.OOe+OO 


====* 

i 

2 . 00e-03 

C3 

pit Td 

-2.30e-01 

0 . 00e+00 

< 

i 

i 

1.00e-04 

C4 

rol bw pd 

0 . 00e+00 

0 . 00e+00 



i 

2. 00e-03 

C5 

rol Td 

-2 . 90e-01 

0 . 00e+00 

< 

i 

i 

1.00e-04 

C6 

yaw bw pd 

O.OOe+OO 

0 . 00e+00 


====* 

i 

2 . OOe-03 

C7 

yaw Td 

-3.56e-01 

O.OOe+OO 

< 

i 

i 

1.00e-04 

C8 

pit damp 

6 . 67e-05 

0 . 00e+00 


== * 

i 

1. 00e-03 

C9 

rol damp 

0 . 00e+00 

0 . 00e+00 


====* 

i 

1. 00e-03 

CIO 

yaw damp 
pit quickl 
pit quick2 
pit quick3 

0 . 00e+00 

0 . 00e+00 


====* 

i 

1. 00e-03 

Cll 

4.27e-01 

0 . 00e+00 

II 

II 

II 

II 

II 

V 


ti 

ti 

it 

ii 

n 

ii 

it 

ii 

n 

n 

ii 

ii 

n 

n 

n 

n 

ii 

n 

-6 . 00e-02 

C12 

6.25e-01 

0 . 00e+00 

< 


n 

n 

ii 

n 

n 

n 

n 

ii 

n 

n 

n 

n 

ii 

ii 

it 

n 

it 

n 

-4.00e-02 

C13 

6 . 04e-01 

0 . 00e+00 

A 

II 

II 

II 

II 

II 

ii 

ti 

» 

n 

it 

ii 

it 

it 

n 

ti 

n 

n 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

ii 

ti 

ii 

ti 

-3 . 00e-02 

C14 

rol quickl 

2.46e-01 

O.OOe+OO 

A 

II 

II 

II 

II 

II 

ii 

» 

it 

it 

ii 

ii 

ii 

it 

n 

ll 

n 

n 

n 

n 

n 

n 

n 

n 

n 

ii 

ii 

n 

n 

n 

n 

n 

-I .40e-02 

C15 

rol quick2 

5.71e-01 

0 . OOe+OO 

<===== 

ii 

ii 

n 

ti 

ti 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

n 

ii 

n 

n 

ii 

n 

n 

n 

ii 

ii 

n 

n 

-8 .00e-02 

C16 

C17 

rol quick3 
yaw quickl 

9.74e-02 

8.26e-01 

0 . 00e+00 
O.OOe+OO 




-7 . 00e-02 
-1.00e-01 

N — — — 



C18 

yaw quick2 

5 . 39e-01 

O.OOe+OO 

< 

ii 

ii 

n 

n 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

it 

it 

ii 

it 

n 

n 

n 

n 

n 

n 

ii 

ii 

n 

n 

-7 . 00e-02 


100 


C19 yaw quick3 5 . 60e-01 0.00e+00 <=====================”======—= -4 . 00e-02 

C20 yaw dec2 d 0 . 00e+00 0.00e+00 ==========* I 2 . 00e-03 

FC1 pit dec up -1.66e-01 0.00e+00 <== I I 5.00e-02 

FC2 pit dec lo 2.50e-01 0.00e+00 <================================ -5.00e-02 

FC3 rol dec up -2.50e-01 0.00e+00 <== I I 5.00e-02 

FC4 rol dec lo 4.21e-02 0.00e+00 *=============================== -5.00e-02 

FC5 yaw decl u -4.25e+00 0.00e+00 <== I I 5.00e-01 

FC6 yaw decl 1 4.79e+00 0.00e+00 <================================ -5 . 00e-0 1 

FC7 p gust p u -2 . 20e+00 0.00e+00 <== I I 3.00e-01 

FC8 p gust p 1 3 . 96e+00 0.00e+00 <=============—================= -3 . 00e-01 

FC9 p gust t u -4.43e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2 . 89e-01 0.00e+00 <================================ -3.00e-02 

FC11 r gust p u -8 . 98e-01 0.00e+00 <== I I 3.00e-01 

FC12 r gust p 1 3.74e+00 0.00e+00 <================================ -3 . 00e-01 

FC13 r gust t u -4 . 53e-01 0.00e+00 <== I I 3.00e-02 

FC14 r gust t 1 1.42e-01 0.00e+00 <===================="========== -3 . 00e-02 

FC15 y gust p u -3.09e+00 0.00e+00 <== I I 3.00e-01 

FC16 y gust p 1 3 . 97e+00 0.00e+00 <================================ -3.00e-01 

FC17 y gust t u -4.31e-01 0.00e+00 <-= I I 3.00e-02 

FC18 y gust t 1 3 . 18e-01 0 . 00e+00 <================================ -3 . 00e-02 


<4> sim 

Enter MATLAB, type 'back* to leave 

>> specs 

>> prspecs 

>> print 

>> back 

back to SOLVE 

*/, Still in phase 2, run 1 iteration 
<4> run 1 


<5> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Ktet 

9 . 78278e+00 

1.0e+00 

-5*/. 

07. 

Kphi 

9 . 23057e+00 

1.0e+00 

97. 

07. 

Kpsi 

7 . 37243e+00 

1 . 0e+00 

-27. 

07. 

Kq 

7 . 07734e+00 

1 .0e+00 

47. 

07. 

Kp 

2 . 22992e+00 

1.0e+00 

717. 

27. 

Kr 

4 . 51307e+00 

1.0e+00 

127. 

07. 

Mtet 

1 . 99695e+00 

1.0e+00 

07. 

07. 

Mphi 

6 . 04718e+00 

1 .0e+00 

1417. 

27. 

Mpsi 

2. 00000e+00 

1.0e+00 

07. 

07. 

Kr.p 

6 . 21835e-02 

1 . 0e+00 

**** 7 . 

-77. 

Kp_r 

-3 . 24220e-01 

1.0e+00 

**** 7 , 

07. 

Kc_y 

-7 . 20799e-02 

1 .0e+00 

**** 7 . 

107. 


<5> pcomb 


Pcomb (Iter= 5) (Phase 2) (MAX_C0ST_S0FT= 0.00946629) 


SPECIFICATION 

PRESENT 

GOOD 


G B 

BAD 

01 

p_act_rate 

-9 . 19e+01 

0.00e+00 

< = = 

i i 

1 . 00e+00 

02 

r act_rate 

-6.25e+01 

0.00e+00 

<== 

i i 

1.00e+00 

03 

y_act_rate 

-6 . 49e+01 

0 . 00e+00 

< = = 

i i 

1.00e+00 

Cl 

stable all 

-4.53e-02 

0 . 00e+00 

< 

i i 

1.00e-03 

C2 

pit bw pd 

0 . 00e+00 

0 . OOo+OO 


====* | 

2 . 00e-03 

C3 

pit Td 

-2. 30e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C4 

rol bw pd 

0 . 00e+00 

0 . 00e+00 


====* i 

2 . 00e-03 

C5 

rol Td 

-2.91e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C6 

yaw bw pd 

0 . 00e+00 

0.00e+00 


====* i 

2 . 00e-03 

C7 

yaw Td 

-3 . 56e-01 

0.00e+00 

< 

i i 

1.00e-04 

C8 

pit damp 

9 . 47e-06 

0.00e+00 


====* i 

1 . 00e-03 
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C9 

CIO 

Cll 

C12 

C13 

C14 

C15 

C16 

C17 

C18 

C19 

C20 

FC1 

FC2 

FC3 

FC4 

FC5 

FC6 

FC7 

FC8 

FC9 

FCIO 

FC11 

FC12 

FC13 

FC14 

FC15 

FC16 

FC17 

FC18 


rol damp 

0.00e+00 

0.00e+00 

= = = 

yaw damp 

0.00e+00 

0 . 00e+00 

= = = 

pit quickl 
pit quick2 

4 . 26e-01 
6. 24e-01 

0 . 00e+00 
0 . 00e+00 

<== 

^ 

pit quick3 

6 . 03e-01 

0.00e+00 

<= = 

rol quickl 

2 . 45e-01 

0.00e+00 

<= = 

rol quick2 

6 . 07e-01 

0.00e+00 

<= = 

rol quick3 

1 . 19e-01 

0.00e+00 

<= = 

yaw quickl 

8. 27e-01 

0.00e+00 

<= = 

yaw quick2 

5 . 39e-01 

0.00e+00 

<= = 

yaw quick3 

5 . 60e-01 

0.00e+00 

<= = 

yaw dec2 d 

0.00e+00 

0.00e+00 

= = = 

pit dec up 

-1 . 66e-01 

0.00e+00 

<= = 

pit dec lo 

2. 50e-01 

0.00e+00 

<= = 

rol dec up 

-2 . 50e-01 

0.00e+00 

<= = 

rol dec lo 

4 . 31e-02 

0.00e+00 

* = 

yaw decl u 

-4 . 26e+00 

0.00e+00 

< = = 

yaw decl 1 

4 . 85e+00 

0.00e+00 

< = = 

p gust p u 

-2 . 19e+00 

0.00e+00 

< = = 

p gust p 1 

3 . 96e+00 

0.00e+00 

< = = 

p gust t u 

-4 . 44e-01 

0.00e+00 

< = = 

p gust t 1 

2 . 88e-01 

0.00e+00 

< = = 

r gust p u 

-9 . 25e-01 

0.00e+00 

< = = 

r gust p 1 

3 . 74e+00 

0.00e+00 

< = = 

r gust t u 

-4 . 53e-01 

0.00e+00 

<== 

r gust t 1 

1 . 42e-01 

0.00e+00 

<== 

y gust p u 

-3 . 09e+00 

0 . 00e+00 

<== 

y gust p 1 

3 . 97e+00 

0.00e+00 

< = = 

y gust t u 

-4 . 31e-01 

0 . 00e+00 

<== 

y gust t 1 

3 . 18e-01 

0 . 00e+00 

<== 


<5> run 1 


1.00e-03 
1.00e-03 
-6 . 00e-02 
-4 . 00e-02 
-3 . 00e-02 
-1 . 40e-02 
-8 . 00e-02 
-7 . 00e-02 
-1. OOe-Ol 
-7 . 00e-02 
-4 . 00e-02 
2 . 00e-03 
5 . 00e-02 
-5 .00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . OOe-Ol 
-5 . OOe-Ol 
3 . OOe-Ol 
-3. OOe-Ol 
3 . 00e-02 
-3 . 00e-02 
3. OOe-Ol 
-3. OOe-Ol 
3 .00e-02 
-3 . 00e-02 
3. OOe-Ol 
-3. OOe-Ol 
3 . 00e-02 
-3 . 00e-02 


<6> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Ktet 

9 . 75853e+00 

1.0e+00 

- 6 */. 

07. 

Kphi 

9 . 24782e+00 

1.0e+00 

10*/. 

07. 

Kpsi 

7 . 36767e+00 

1.0e+00 

-3'/. 

07. 

Kq 

7 . 08728e+00 

1.0e+00 

47. 

07. 

Kp 

2 . 25177e+00 

1.0e+00 

737. 

07. 

Kr 

4 . 52359e+00 

1.0e+00 

137. 

07. 

Mtet 

1 . 99686e+00 

1.0e+00 

07. 

07. 

Mphi 

6 . 10938e+00 

1.0e+00 

1447. 

17. 

Mpsi 

2 . 00000e+00 

1.0e+00 

07. 

07. 

Kr_p 

6 . 02392e-02 

1.0e+00 

****'/, 

- 37 . 

Kp_r 

-3 . 25297e-01 

1.0e+00 

****'/. 

07. 

Kc_y 

-7 . 45238e-02 

1.0e+00 

****'/, 

37 . 


<6> pcomb 

Pcomb (Iter= 6) (Phase 2) (MAX_C0ST_S0FT= 0.00134145) 


SPECIFICATION PRESENT 

GOOD 


G B 

BAD 

01 

p_act_rate -9.19e+01 

0.00e+00 

< = = 

i i 

1.00e+00 

02 

r_act_rate -6.24e+01 

0 . 00e+00 

< = = 

i i 

1.00e+00 

03 

y_act_rate -6.49e+01 

0 . 00e+00 

< = = 

i i 

1.00e+00 

Cl 

stable all -4.53e-02 

0 . 00e+00 

< 

i i 

1.00e-03 

C2 

pit bw pd 0.00e+00 

0 . 00e+00 


:===♦ | 

2 . 00e-03 

C3 

pit Td -2.30e-01 

0.00e+00 

< 

1 1 

1.00e-04 

C4 

rol bw pd 0.00e+00 

0 . 00e+00 

= = = 

====* | 

2 . 00e-03 

C5 

rol Td -2. 91e-01 

0.00e+00 

< 

1 1 

1.00e-04 

C6 

yaw bw pd 0.00e+00 

0 . 00e+00 

= 

====* | 

2 . 00e-03 

C7 

yaw Td -3.56e-01 

0.00e+00 

< 

1 1 

1.00e-04 
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C8 

C9 

CIO 

pit damp 
rol damp 
yaw damp 
pit quickl 
pit quick2 
pit quick3 
rol quickl 
rol quick2 
rol quick3 
yaw quickl 
yaw quick2 
yaw quick3 
yaw dec2 d 
pit dec up 
pit dec lo 
rol dec up 

_ _ i j — — i _ 

1 . 34e-06 
0.00e+00 
0.00e+00 

A OCa Ai 

0.00e+00 

0.00e+00 

0.00e+00 


==* 1 

1.00e-03 

1.00e-03 

1.00e-03 

_ft AAtt AO 


— * 1 

— a, 1 


* | 

Lll 

ft . zoe-ui 

u . uue+uu 

v 


O • V vC V 

—A A Ac AO 

LI z 

b . z^ie-ui 

C. AOa A 4 

u . uue+uu 

x — — — — 


. uue uz 
q nnn ao 

Llo 

b . u^e ui 

A A1 

u . uue+uu 

v 


o . uue uz 
1 AAj» ao 

L14 

z . *±oe”Ui 

C. AAa A 1 

u . uue+uu 

\ 


i . *tue uz 

Q AAia AO 

Lib 

b . ^ue-ui 

4 A*7« A 4 

u . uue+uu 



£J • UUv UZ 

-7 nn^-no 

Lib 

C17 

l . z f e ui 
8 . 27e-01 

c oDa r\4 

u . uue+uu 
0.00e+00 



f • V Vu vZ 

-1.00e-01 
7 nna ao 




Llo 
n 4 n 

o . oye-ui 

C CA-r. Ai 

u . uue+uu 




( . uue uz 
A AAo AO 

Liy 

C20 

FC1 

o . bue-ui 
0.00e+00 
-1.66e-01 

A CAa A 4 

u . uue+uu 
0.00e+00 
0.00e+00 

v. 


. uue uz 
2 . 00e-03 

5 . 00e-02 
t; nno.no 


* j 

1 1 

r L z 

FC3 

£+ * O U6 v 1 

-2 . 50e-01 

u . uue+uu 
0.00e+00 

A AAj-._i.AA 

s— — 

1 1 

o . uue uz 
5 . 00e-02 

-ft AAo- AO 

r L4 

FC5 

FC6 

FC7 

FC8 

FC9 

rol aec lo 
yaw decl u 
yaw decl 1 
p gust p u 
p gust p 1 
p gust t u 
p gust t 1 
r gust p u 
r gust p 1 
r gust t u 
r gust t 1 
y gust p u 
y gust p 1 
y gust t u 
y gust t 1 

*1 * 006 V4U 

-4 . 26e+00 
4 . 87e+00 
-2 . 19e+00 
3 . 96e+00 
-4 . 45e-01 

A QVtt-.ni 

u . uue+uu 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 

A AAr> i AA 

W — 

s __ — . _ 

1 1 

o . uue uz 
5 . 00e-01 
-5 . 00e-01 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 

_ o AAo- AO 

\— — — 

1 1 

< 

<== 

V*— —————— 

1 1 

r LIU 
FC11 
FC12 
FC13 

pp 4 A 

Z.of e-Ul 

-9.35e-01 
3 . 74e+00 
-4.53e-01 

i 40tt-.ni 

u . uue+uu 
0.00e+00 
0.00e+00 
0 . 00e+00 

A A A n i A A 

V — 

1 1 

o . uue uz 
3 . 00e-01 
-*3 . 00e-01 
3 . 00e-02 

_q AA<=»- AO 

\ 

<== 

.s'*——— — — — — 

1 1 

r L14 
FC15 
FC16 
FC17 

T?rt 4 Q 

l . ^ze ui 
-3 . 09e+00 
3 . 97e+00 
-4 . 31e-01 

q i Qtt_m 

u . uue+uu 
0 . 00e+00 
0 . 00e+00 
0 . 00e+00 

A AArti-AA 

— — — — — 

s— . 

1 1 

O • UU6 u Z 

3 . 00e-01 
-3 . 00e-01 

3 . 00e-02 
-o AAo- AO 

s.— —————— 

X— — — 

1 1 

r Llo 

o . loe-ui 

u . uue+uu 

x— — 


O * v U C U Z 


X Still in phase 2, run 2 more iterations 


<6> run 2 


<8> pcomb 

Pcomb (Iter= 8) (Phase 2) (MAX_C0ST_S0FT= 2.66865e-05) 


SPECIFICATION 

PRESENT 

GOOD 


G 

B 

BAD 

01 

p_act_rate 

-9 . 19e+01 

0 . 00e+00 

<= = 

i 

i 

1.00e+00 

02 

r_act rate 

-6 . 24e+01 

0 . 00e+00 

< = = 

i 

i 

1.00e+00 

03 

y_act_rate 

-6 . 49e+01 

0.00e+00 

< = = 

i 

i 

1.00e+00 

Cl 

stable all 

-4.54e-02 

0 . 00e+00 

< 

i 

i 

1.00e-03 

C2 

pit 

bw pd 

0.00e+00 

0.00e+00 


===* 

i 

2 . 00e-03 

C3 

pit 

Td 

-2.30e-01 

0.00e+00 

< 

i 

i 

1.00e-04 

C4 

rol 

bw pd 

0 . 00e+00 

0 . 00e+00 


===* 

i 

2 . 00e-03 

C5 

rol 

Td 

-2.91e-01 

0.00e+00 

< 

i 

i 

1.00e-04 

C6 

yaw 

bw pd 

0 . 00e+00 

0 . 00e+00 


===* 

i 

2. OOe-03 

C7 

yaw 

Td 

-3.56e-01 

0.00e+00 

< 

i 

i 

1.00e-04 

C8 

pit 

damp 

2.67e-08 

0 . 00e+00 


===* 

i 

1 . 00e-03 

C9 

rol 

damp 

0.00e+00 

0 . 00e+00 


===* 

i 

1.00e-03 

CIO 

yaw 

damp 

0 . 00e+00 

0 . 00e+00 


===* 

i 

1.00e-03 

Cll 

pit 

quickl 

4. 25e-01 

0 . 00e+00 

< = 

ii 

n 

n 

ii 

n 

ii 

n 

n 

n 

ii 

n 

n 

n 

n 

n 

n 

n 

ii 

ii 

n 

ii 

n 

n 

n 

n 

n 

-6 . 00e-02 

C12 

pit 

quick2 

6 . 23e-01 

0 . 00e+00 

II 

II 

II 

II 

It 

It 

V 

n 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

n 

ii 

n 

it 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

n 

ii 

n 

-4.00e-02 

C13 

pit 

quick3 

6.02e-01 

0 . 00e+00 

<====== 

ii 

ii 

n 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

n 

n 

n 

n 

n 

ii 

n 

n 

n 

n 

n 

ii 

ii 

n 

n 

ii 

-3 . 00e-02 

C14 

rol 

quickl 

2.45e-01 

0 . 00e+00 

II 

II 

II 

II 

II 

II 

V 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

n 

ii 

n 

ii 

n 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

n 

-1.40e-02 

C15 

rol 

quick2 

6 . 26e-01 

0 . 00e+00 

<====== 

n 

n 

n 

n 

n 

n 

n 

n 

n 

n 

ii 

ii 

n 

n 

n 

n 

n 

n 

n 

n 

ii 

ii 

n 

ii 

ii 

ii 

-8 .00e-02 

C16 

rol 

quick3 

1.31e~01 

0 . 00e+00 

II 

II 

II 

II 

II 

II 

V 

n 

ii 

ii 

ii 

ii 

n 

ii 

n 

n 

n 

n 

n 

ii 

ii 

n 

ii 

ii 

ii 

ii 

ii 

it 

ii 

ii 

ii 

ii 

ii 

-7 .00e-02 

C17 

yaw 

quickl 

8.27e-01 

0 . 00e+00 

< 

n 

n 

it 

n 

ii 

it 

n 

n 

n 

n 

n 

n 

ii 

n 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

it 

n 

-1.00e-01 

C18 

yaw 

quick2 

5.39e-01 

0 . 00e+00 

II 

II 

II 

II 

II 

II 

V 

n 

n 

n 

n 

ii 

n 

n 

n 

n 

n 

n 

ii 

n 

ii 

ii 

n 

n 

n 

ii 

ii 

n 

ii 

ii 

n 

ii 

ii 

-7 .00e-02 

C19 

yaw 

quick3 

5.60e-01 

0.00e+00 

A 

II 

II 

II 

II 

II 

II 

ii 

ii 

n 

ii 

n 

n 

ii 

n 

n 

ii 

n 

ii 

n 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

ii 

ii 

fi 

ii 

ii 

-4 . 00e-02 

C20 

yaw 

dec2 d 

0.00e+00 

0.00e+00 


===* 

i 

2 . 00e-03 
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FC1 pit dec up -1.66e-01 0.00e+00 <== I I 5.00e-02 

FC2 pit dec lo 2.50e-01 0.00e+00 <================================ -5.00e-02 

FC3 rol dec up -2.50e-01 0.00e+00 <== I I 5.00e-02 

FC4 rol dec lo 4.36e-02 0.00e+00 *================================ -5.00e-02 

FC5 yaw decl u -4.26e+00 0.00e+00 <== I I 5.00e-01 

FC6 yaw decl 1 4 . 88e+00 0.00e+00 <================================ -5 . 00e-01 

FC7 p gust p u -2.19e+00 0.00e+00 <== I I 3.00e-01 

FC8 p gust p 1 3 . 96e+00 0.00e+00 <================================ -3 . 00e-0 1 

FC9 p gust t u -4.45e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2.87e-01 0.00e+00 <================================ -3 . 00e-02 

FC11 r gust p u -9.41e-01 0.00e+00 <== I I 3.00e-01 

FC12 r gust p 1 3 . 74e+00 0.00e+00 <================================ -3 . 00e-01 

FC13 r gust t u -4.53e-01 0.00e+00 <== I I 3.00e-02 

FC14 r gust t 1 1 . 42e-01 0.00e+00 <================================ -3 . 00e-02 

FC15 y gust p u -3.09e+00 0.00e+00 <== I I 3.00e-01 

FC16 y gust p 1 3 . 97e+00 0.00e+00 <================================ -3 . 00e-01 

FC17 y gust t u -4.31e-01 0.00e+00 <== I I 3.00e-02 

FC18 y gust t 1 3 . 18e-01 0.00e+00 <================================ -3 . 00e-02 


*/, Note numerous constraints on the "good" boundary, especially C8, use 
•/, , sim > to graphically display pcomb results 

<8> sim 

Enter MATLAB, type ’back’ to leave 

>> specs 

>> prspecs 

» print 

» back 

back to SOLVE 

*/, Push good value of C8 just above present value, using setgb command, 
*/, to shake process into phase 3 

<8> setgb C 8 = 1 . 00e-07 , 1 . 00e-03 
<8> run 0 
<8> pcomb 

*/. Note Phase 3 

Pcomb (Iter= 8) (Phase 3) (MAX_C0ST= -62.3947) 


SPECIFICATION 

PRESENT 

GOOD 


G 

B 

BAD 

01 

p_act_rate 

-9 . 19e+01 

0.00e+00 

<== 

i 

i 

1. 00e+00 

02 

r_act_rate 

-6 . 24e+01 

0 . 00e+00 

< = = 

i 

i 

1. 00e+00 

03 

y_act_rate 

-6 . 49e+01 

0.00e+00 

< = = 

i 

i 

1. 00e+00 

Cl 

stable all 

-4. 54e-02 

0.00e+00 

< 

i 

i 

1.00e-03 

C2 

pit 

bw pd 

0 . 00e+00 

0 . 00e+00 

===== 

* 

i 

2 . 00e-03 

C3 

pit 

Td 

-2.30e-01 

0 . 00e+00 

< 

i 

i 

1.00e-04 

C4 

rol 

bw pd 

0.00e+00 

0.00e+00 

= = == = 

_-====* 

i 

2 . 00e-03 

C5 

rol 

Td 

-2.91e-01 

0 . 00e+00 

< 

i 

i 

1.00e-04 

C6 

yaw 

bw pd 

0 . 00e+00 

0 . 00e+00 

==== = 

* 

i 

2 . 00e-03 

C7 

yaw 

Td 

-3. 56e-01 

0 . OOe+OO 

< 

i 

i 

1.00e-04 

C8 

pit 

damp 

2.67e-08 

1.00e-07 

= = = = 

— ==_=* 

i 

1.00e-03 

C9 

rol 

damp 

0.00e+00 

0 . 00e+00 

=== = 

== * 

i 

1.00e-03 

CIO 

yaw 

damp 

0 . 00e+00 

0 . 00e+00 

=== = 

======* 

i 

1.00e-03 

Cll 

pit 

quick 1 

4.25e-01 

0 . 00e+00 

<== = 

H 

II 

II 

II 

II 

II 

II 

II 

II 

II 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

n 

it 

ii 

ii 

n 

n 

n 

n 

n 

it 

ii 

it 

-6 . 00e-02 

C12 

pit 

quick2 

6.23e-01 

0 . 00e+00 

<=== 


n 

ii 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

ii 

n 

n 

ii 

| 

-4 . 00e-02 

C13 

pit 

quick3 

6 . 02e-01 

0 . 00e+00 

<=== 

II 

It 

It 

II 

II 

II 

II 

II 

II 

II 

ii 

ii 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

ii 

ii 

ii 

it 

ii 

n 

ii 

-3. 00e-02 

C14 

rol 

quick 1 

2.45e-01 

0. 00e+00 

<=== 

II 

It 

II 

II 

It 

II 

II 

II 

II 

II 

ii 

ii 

ii 

ii 

n 

n 

ii 

n 

n 

n 

ii 

n 

n 

ii 

ii 

ii 

ii 

ii 

ii 

-1 . 40e-02 

C15 

rol 

quick2 

6.26e-01 

0 . 00e+00 

<=== 

II 

II 

II 

II 

II 

H 

II 

II 

II 

II 


-8 . 00e-02 

C16 

rol 

quick3 

1 . 31e-01 

0 . 00e+00 

<=== 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

n 

ii 

ii 

ii 

ii 

n 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

n 

ii 

ii 

ii 

ii 

-7 . 00e-02 

C17 

yaw 

quickl 

8.27e-01 

0. 00e+00 

< = = = 

=====—• 

n 

ii 

n 

ii 

n 

ii 

ii 

n 

ii 

ii 

ii 

ii 

it 

ii 

ii 

n 

ii 

ii 

ii 

-1.00e-01 

C18 

yaw 

quick 2 

5 . 39e-01 

0 . 00e+00 

<== = 


n 

ii 

ii 

n 

n 

ii 

ii 

ii 

ii 

n 

ii 

ii 

ii 

ii 

!! 

11 

-7 .00e-02 

C19 

yaw 

quick3 

5 . 60e-01 

0. 00e+00 

< = = = 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

-4 . 00e-02 
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C20 yaw dec2 d 0 . 00e+00 0.00e+00 ==========* | 2 . 00e-03 

FC1 pit dec up -1.66e-01 0.00e+00 <== I I 5.00e-02 

FC2 pit dec lo 2 . 50e-01 0 . 00e+00 <================================ -5 . 00e-02 

FC3 rol dec up -2.50e-01 0.00e+00 <== I I 5.00e-02 

FC4 rol dec lo 4.36e-02 0.00e+00 *================================== -5.00e-02 

FC5 yaw decl u -4.26e+00 0.00e+00 <== I I 5.00e-01 

FC6 yaw decl 1 4 . 88e+00 0.00e+00 <=======■***“«“““*“»“-=-== -5 . 00e-01 

FC7 p gust p u -2.19e+00 0.00e+00 <== I I 3.00e-01 

FC8 p gust p 1 3 . 96e+00 0 . 00e+00 <================================ -3 . 00e-01 

FC9 p gust t u -4.45e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2.87e-01 0.00e+00 <================================ -3.00e-02 

FC11 r gust p u -9.41e-01 0.00e+00 <== I I 3.00e-01 

FC12 r gust p 1 3. 74e+00 0.00e+00 <================================ -3.00e-01 

FC13 r gust t u -4.53e-01 0.00e+00 <== I I 3.00e-02 

FC14 r gust t 1 1 . 42e-01 0.00e+00 <================================ -3.00e-02 

FC15 y gust p u -3.09e+00 0.00e+00 <== I I 3.00e-01 

FC16 y gust p 1 3.97e+00 0 . 00e+00 <================================ -3 . 00e-01 

FC17 y gust t u -4.31e-01 0.00e+00 <== I I 3.00e-02 

FC18 y gust t 1 3 . 18e-01 0.00e+00 <============================—=== -3.00e-02 


*/, Now in phase 3, concerned only with the objectives, so to speed up process 
% reduce priority of following constraints 


<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 
<8> setgb 


C 11 =0, -10e4 
C 12 =0 , -10e4 
C 13 =0 , -10e4 
C 14 =0 , -10e4 
C 15 =0 , -10e4 
C 16 =0 , -10e4 
C 17 =0, -10e4 
C 18 =0, -10e4 
C 19 =0, -10e4 


7, Weight the first objective in order to push it toward the boundary 


<8> setgb 0 1 =0,10 
<8> run 0 
<8> pcomb 

Pcomb (Iter= 8) (Phase 3) (MAX_C0ST= -9.18756) 


SPECIFICATION 

PRESENT 

GOOD 

G 

B 


01 

p_act_rate 

-9 . 19e+01 

0.00e+00 <== 

i 

i 


02 

r_act_rate 

-6.24e+01 

0.00e+00 <== 

i 

i 


03 

y_act_rate 

-6 . 49e+01 

0.00e+00 <== 

i 

i 


Cl 

stable all 

-4 . 54e-02 

0.00e+00 <-- 

i 

i 


C2 

pit 

bw pd 

0.00e+00 

0.00e+00 ===== 

= ==* 

i 


C3 

pit 

Td 

-2 . 30e-01 

0.00e+00 < — 

i 

i 


C4 

rol 

bw pd 

0.00e+00 

0.00e+00 = 

= — = — * 

i 


C5 

rol 

Td 

-2 . 91e-01 

0.00e+00 <— 

i 

i 


C6 

yaw 

bw pd 

0.00e+00 

0.00e+00 ===== 

:=== * 

i 


C7 

yaw 

Td 

-3.56e-01 

0.00e+00 <— 

1 

i 


C8 

pit 

damp 

2 . 67e-08 

1.00e-07 ===== 

= = * 

i 


C9 

rol 

damp 

0.00e+00 

0.00e+00 ===== 

= ==-* 

i 


CIO 

yaw 

damp 

0.00e+00 

0.00e+00 =-=-= 

= = * 

i 


Cll 

pit 

quick 1 

4.25e-01 

0 . 00e+00 

*-=_== 

== — == 


C12 

pit 

quick2 

6 . 23e-01 

0 . 00e+00 

*===== 

== = 


C13 

pit 

quick3 

6. 02e-01 

0.00e+00 

*===-= 

=========== 


C14 

rol 

quickl 

2 . 45e-01 

0.00e+00 

*=ssss 

== — = — = 


C15 

rol 

quick2 

6 . 26e-01 

0.00e+00 

*===== 

= 


C16 

rol 

quick3 

1 . 31e-01 

0.00e+00 

*=== — 

===_= 


C17 

yaw 

quickl 

8 . 27e-01 

0.00e+00 

4c == 

= 


C18 

yaw 

quick2 

5 . 39e-01 

0 . 00e+00 

* 

= =_===== 

====—_ 

C19 

yaw 

quick3 

5 . 60e-01 

0.00e+00 

* 




BAD 

1.00e+01 
1.00e+00 
1.00e+00 
1.00e-03 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
1.00e-03 
1.00e-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
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C20 yaw dec2 d 0.00e+00 0.00e+00 ==========* | 2.00e-03 

FC1 pit dec up -1.66e-01 0.00e+00 <== I I 5.00e-02 

FC2 pit dec lo 2.50e-01 0.00e+00 <================================ -5.00e-02 

FC3 rol dec up -2.50e-01 0.00e+00 <== I I 5.00e-02 

FC4 rol dec lo 4.36e-02 0.00e+00 *================================ -5.00e-02 

FC5 yaw decl u -4.26e+00 0.00e+00 <== I I 5.00e-01 

FC6 yaw decl 1 4.88e+00 0.00e+00 <================================ -5.00e-01 

FC7 p gust p u -2. 19e+00 0.00e+00 <== I I 3.00e-01 

FC8 p gust p 1 3 . 96e+00 0.00e+00 <================================ -3 . 00e-01 

FC9 p gust t u -4.45e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2 . 87e-01 0.00e+00 <================================ -3.00e-02 

FC11 r gust p u -9.41e-01 0.00e+00 <== I I 3.00e-01 

FC12 r gust p 1 3.74e+00 0.00e+00 <================================ -3.00e-01 

FC13 r gust t u -4.53e-01 0.00e+00 <== I I 3.00e-02 

FC14 r gust t 1 1 . 42e-01 0.00e+00 <================================ -3.00e-02 

FC15 y gust p u -3.09e+00 0.00e+00 <== I I 3.00e-01 

FC16 y gust p 1 3 . 97e+00 0.00e+00 <================================ -3 . 00e-01 

FC17 y gust t u -4.31e-01 0.00e+00 <== I I 3.00e-02 

FC18 y gust t 1 3 . 18e-01 0.00e+00 <================================ -3.00e-02 

<8> run 2 


<10> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Ktet 

9.68140e+00 

1.0e+00 

-67. 

07. 

Kphi 

9 . 25585e+00 

1.0e+00 

107. 

07. 

Kpsi 

7 . 36426e+00 

1.0e+00 

-37. 

07. 

Kq 

7 . 06584e+00 

1.0e+00 

37. 

07. 

Kp 

2. 26597e+00 

1.0e+00 

747. 

07. 

Kr 

4 . 52861e+00 

1.0e+00 

137. 

07. 

Mtet 

1 . 32703e+00 

1.0e+00 

-337. 

-67. 

Mphi 

6 . 14147e+00 

1.0e+00 

1457. 

07. 

Mpsi 

2. 00000e+00 

1.0e+00 

07. 

07. 

Kr_p 

8 . 29262e-02 

1.0e+00 

****'/. 

107. 

Kp_r 

-3 . 17911e-01 

1 . 0e+00 

*#**7. 

-27. 

Kc_y 

-7 . 57832e-02 

1.0e+00 

****7. 

07. 


<10> sim 

Enter MATLAB, type ’back' to leave 
>> specs 
>> back 
back to SOLVE 


'/, First objective has been pushed to boundary, weight second objective 
7, to try and push it 

<10> setgb 0 1 =0,1 
<10> setgb 0 2 =0,10 
<10> run 0 
<10> pcomb 

Pcomb (Iter= 10) (Phase 3) (MAX_C0ST= -6.2533) 


SPECIFICATION 

PRESENT 

GOOD 


G B 

BAD 

01 

p_act_rate 

-9.83e+01 

0 . 00e+00 

< = = 

i i 

1 . 00e+00 

02 

r_act_rate 

-6 . 25e+01 

0 . 00e+00 

< = = 

i i 

1 . 00e+01 

03 

y_act_rate 

-6.49e+01 

0 . 00e+00 

< = = 

i i 

1 . 00e+00 

Cl 

stable all 

-4.39e-02 

0 . 00e+00 

< 

i i 

1.00e-03 

C2 

pit bw pd 

0 . 00e+00 

0 . 00e+00 


====* 1 

2 . 00e-03 

C3 

pit Td 

-2. 10e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C4 

rol bw pd 

0 . 00e+00 

0 . 00e+00 


====* i 

2 . 00e-03 

C5 

rol Td 

-2.91e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C6 

yaw bw pd 

0.00e+00 

0.00e+00 


====* i 

2 . 00e-03 

C7 

yaw Td 

-3 . 56e-01 

0.00e+00 

< 

i i 

1.00e-04 

C8 

pit damp 

6 . 29e-08 

1.00e-07 

II 

II 

II 

II 

II 

II 

====* i 

1.00e-03 
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C9 

CIO 

Cll 

C12 

C13 

C14 

C15 

C16 

C17 

C18 

C19 

C20 

FC1 

FC2 

FC3 

FC4 

FC5 

FC6 

FC7 

FC8 

FC9 

FCIO 

FC11 

FC12 

FC13 

FC14 

FC15 

FC16 

FC17 

FC18 


rol damp 
yaw damp 
pit quickl 
pit quick2 
pit quick3 
rol quickl 
rol quick2 
rol quick3 
yaw quickl 
yaw quick2 
yaw quick3 
yaw dec2 d 
pit dec up 
pit dec lo 
rol dec up 
rol dec lo 
yaw decl u 
yaw decl 1 
p gust p u 
p gust p 1 
p gust t u 
p gust t 1 
r gust p u 
r gust p 1 
r gust t u 
r gust t 1 
y gust p u 
y gust p 1 
y gust t u 
y gust t 1 


0.00e+00 
0.00e+00 
1.40e-02 
2 . 72e-01 
3.48e-01 
2.49e-01 
6. 34e-01 
1.36e-01 
8 . 27e-01 
5 . 39e-01 
5 . 60e-01 
0.00e+00 
-1.62e-01 
2 . 50e-01 
-2 . 50e-01 
8. lle-02 
-4. 26e+00 
4 . 88e+00 
-2 . 19e+00 
3 . 96e+00 
-4.41e-01 
2.85e-01 
-9. 53e-01 
3. 76e+00 
-4.57e-01 
1 . 57e-01 
-3 . 09e+00 
3. 97e+00 
-4 . 32e-01 
3 . 16e-01 


0.00e+00 ==========♦ 

0.00e+00 ==========* 

0.00e+00 * 

0.00e+00 * 

0.00e+00 * 

0.00e+00 * 

0.00e+00 * 

0 . 00e+00 * 

0.00e+00 * 

0.00e+00 * 

0 . 00e+00 * 


0.00e+00 ==========* 


0.00e+00 
0 . 00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0 . 00e+00 
0 . 00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 



0.00e+00 <== I 

0 . 00e+00 <============= 


<10> run 2 
<12> print 


Name 

Value 

Ktet 

9 ► 08983e+00 

Kphi 

9 . 55674e+00 

Kpsi 

7 . 35924e+00 

Kq 

7 . 24229e+00 

Kp 

2 . 12648e+00 

Kr 

4 . 52575e+00 

Mtet 

1 . 32703e+00 

Mphi 

5 . 97543e+00 

Mpsi 

2 . 00000e+00 

Kr_p 

2 . 54135e-01 

Kp_r 

-3 . 08781e-01 

Kc_y 

-7 . 57832e-02 

<12> pcomb 



Variation 

wrt 0 

Prev 

1.0e+00 

-6*/. 

-5'/. 

1.0e+00 

3*/. 

3*/. 

1.0e+00 

0*/. 

OX 

1.0e+00 

21 

21 

1.0e+00 

-61 

-61 

1.0e+00 

01 

01 

1.0e+00 

01 

01 

1.0e+00 

-21 

-21 

1 . 0e+00 

07 . 

01 

1 . 0e+00 

2061 

153*/. 

1 . 0e+00 

-21 

-37. 

1.0e+00 

01 

07. 


Pcomb (Iter= 12) (Phase 3) (MAX_C0ST= -6.40774) 


I 

I 



Iter=12 


1.00e-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
2 . 00e-03 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-01 
-5 . 00e-01 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3.00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 


SPECIFICATION 

PRESENT 

GOOD 


G B 

BAD 

01 

p_act_rate 

-9.82e+0i 

0 . 00e+00 

< = = 

i i 

1.00e+00 

02 

r_act_rate 

-6.41e+01 

0 . 00e+00 

< = = 

i i 

1.00e+01 

03 

y_act_rate 

-6.49e+01 

0.00e+00 

< = = 

i i 

1.00e+00 

Cl 

stable all 

-3 . 19e-02 

0 . 00e+00 

< 

i i 

1.00e-03 

C2 

pit bw pd 

0.00e+00 

0.00e+00 


====* 1 

2 . 00e-03 

C3 

pit Td 

-2.03e-01 

0.00e+00 

< 

i i 

1 . 00e-04 

C4 

rol bw pd 

0 . 00e+00 

0 . 00e+00 

: 

====* i 

2 . 00e-03 

C5 

rol Td 

-2.89e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C6 

yaw bw pd 

0 . 00e+00 

0 . 00e+00 

===== 

====* i 

2 . 00e-03 

C7 

yaw Td 

-3.56e-01 

0 . 00e+00 

< — 

i i 

1.00e-04 

C8 

pit damp 

0.00e+00 

1.00e-07 

======= 

====* i 

1.00e-03 
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C9 

rol damp 

0.00e+00 

0 . 00e+00 

= = = : 

CIO 

yaw damp 

0.00e+00 

0.00e+00 

= = = : 

Cll 

pit quickl 

3.06e-02 

0.00e+00 


C12 

pit quick2 

2 . 85e-01 

0.00e+00 


C13 

pit quick3 

3 . 56e-01 

0.00e+00 


C14 

rol quickl 

2 . 91e-01 

0.00e+00 


C15 

rol quick2 

6 . 61e-01 

0.00e+00 


C16 

rol quick3 

1.56e-01 

0.00e+00 


C17 

yaw quickl 

8 . 28e-01 

0.00e+00 


C18 

yaw quick2 

5 . 38e-01 

0.00e+00 


C19 

yaw quick3 

5 . 59e-01 

0.00e+00 


C20 

yaw dec2 d 

0.00e+00 

0.00e+00 

===== 

FC1 

pit dec up 

-1 . 34e-01 

0.00e+00 

< = = 

FC2 

pit dec lo 

2 . 50e-01 

0.00e+00 

< = = 

FC3 

rol dec up 

-2 . 50e-01 

0.00e+00 

< = = 

FC4 

rol dec lo 

8 . 66e-02 

0.00e+00 

<==: 

FC5 

yaw decl u 

-4. 26e+00 

0.00e+00 

<== 

FC6 

yaw decl 1 

4 . 88e+00 

0.00e+00 

<== = 

FC7 

p gust p u 

-2 . 20e+00 

0.00e+00 

<== 

FC8 

p gust p 1 

4.00e+00 

0 . 00e+00 

<== : 

FC9 

p gust t u 

-3. 95e-01 

0 . 00e+00 

<== 

FC10 

p gust t 1 

2 . 64e-01 

0 . 00e+00 

<=== 

FC11 

r gust p u 

-1 . 02e+00 

0.00e+00 

< = = 

FC12 

r gust p 1 

3 . 90e+00 

0.00e+00 

<==: 

FC13 

FC14 

r gust t u 
r gust t 1 

-4 . 98e-01 
2 . 52e-01 

0.00e+00 

0.00e+00 

A A 
II II 
II II 

FC15 

y gust p u 

-3.09e+00 

0 . 00e+00 

<== 

FC16 

y gust p 1 

3.97e+00 

0.00e+00 

<=== 

FC17 

y gust t u 

-4 . 32e-01 

0.00e+00 

< = = 

FC18 

<12> 

y gust t 1 
sim 

2 . 97e-01 

0.00e+00 

<==: 

Enter MATLAB, type ’back' 
>> specs 
>> back 
back to SOLVE 

to leave 



:* 

:* 

* 

* 

* 

* 


I 

I 


*: 


* 


* 


* 


* 


1.00e-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
2.00e-03 
5 .00e-02 
-5 .00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-01 
-5 .00e-01 
3 . 00e-01 
-3. 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 .00e-01 
-3 .00e-01 
3 . 00e-02 
-3 . 00e-02 


7. Note in the last 2 iterations the second objective changed very 
7 little, rather than try and continue to push it, freeze some dp>s (to 
7, speed up the optimization) and try to push the third objective, then 
7, return to the second objective 


<12> freeze Ktet Kphi Kpsi Kq Kp Kr 

<12> setgb 0 2 =0,le00 

<12> setgb 0 3 =0 , led 

<12> run 0 

<12> pcomb 

Pcomb (Iter= 12) (Phase 3) (MAX_C0ST= -6.4906) 


SPECIFICATION 

PRESENT 

GOOD 


G B 

BAD 

01 

p_act_rate 

-9 . 82e+01 

0.00e+00 

<== 

i i 

1 . 00e+00 

02 

r_act_rate 

-6.41e+01 

0.00e+00 

< = = 

i i 

1.00e+00 

03 

y_act_rate 

-6 . 49e+01 

0 . 00e+00 

< = = 

i i 

1.00e+01 

Cl 

stable all 

-3. 19e-02 

0 . 00e+00 

< 

i i 

1.00e-03 

C2 

pit bw pd 

0 . 00e+00 

0 . 00e+00 


===* | 

2 . 00e-03 

C3 

pit Td 

-2 . 03e-01 

0 . 00e+00 

< 

i i 

1.00e-04 

C4 

rol bw pd 

0 . 00e+00 

0 . 00e+00 


====* | 

2 . 00e-03 

C5 

rol Td 

-2 . 89e-01 

0 . 00e+00 

< 

1 1 

1.00e-04 

C6 

yaw bw pd 

0 . 00e+00 

0 . 00e+00 



2 . 00e-03 

C7 

yaw Td 

-3 . 56e-01 

0 . 00e+00 

< 

1 1 

1.00e-04 

C8 

pit damp 

0.00e+00 

1 . 00e-07 


====* | 

1.00e-03 

C9 

rol damp 

0 . 00e+00 

0.00e+00 

II 

II 

II 

II 

II 

II 

====* | 

1 . 00e-03 

CIO 

yaw damp 

0.00e+00 

0.00e+00 


====* | 

1.00e-03 

Cll 

pit quickl 

3.06e-02 

0.00e+00 


♦============ 

= -1.00e+05 
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C12 pit quick2 2.85e-01 0.00e+00 *====================== -l.00e+05 

C13 pit quick3 3.56e-01 0.00e+00 *====================== -l.00e+05 

C14 rol quickl 2.91e-01 0.00e+00 *====================== -1.00e+05 

C15 rol quick2 6.61e-01 0.00e+00 *====================== -1.00e+05 

C16 rol quick3 1.56e-01 0.00e+00 *====================== -1.00e+05 

C17 yaw quickl 8.28e-01 0.00e+00 *====================== -l.00e+05 

C18 yaw quick2 5 . 38e-01 0.00e+00 *====================== -1.00e+05 

C19 yaw quick3 5 . 59e-01 0.00e+00 *====================== - 1 . 00e+05 

C20 yaw dec2 d 0 . 00e+00 0.00e+00 ==========* I 2 . 00e-03 

FC1 pit dec up -1.34e-01 0.00e+00 <== I I 5.00e-02 

FC2 pit dec lo 2.50e-01 0.00e+00 <================================ -5.00e-02 

FC3 rol dec up -2.50e-01 0.00e+00 <== I I 5.00e-02 

FC4 rol dec lo 8.66e-02 0.00e+00 <================================ -5.00e-02 

FC5 yaw decl u -4.26e+00 0.00e+00 <== I I 5.00e-01 

FC6 yaw decl 1 4.88e+00 0.00e+00 <================================ -5.00e-01 

FC7 p gust p u -2.20e+00 0.00e+00 <== I I 3.00e-01 

FC8 p gust p 1 4.00e+00 0.00e+00 <================================ -3.00e-01 

FC9 p gust t u -3.95e-01 0.00e+00 <== I I 3.00e-02 

FC10 p gust t 1 2.64e-01 0.00e+00 <================================ -3.00e-02 

FC11 r gust p u -1.02e+00 0.00e+00 <== I I 3.00e-01 

FC12 r gust p 1 3.90e+00 0.00e+00 <================================ -3.00e-01 

FC13 r gust t u -4.98e-01 0.00e+00 <== I I 3.00e-02 

FC14 r gust t 1 2.52e-01 0.00e+00 <================================ -3.00e-02 

FC15 y gust p u -3.09e+00 0.00e+00 <== I I 3.00e-01 

FC16 y gust p 1 3.97e+00 0.00e+00 <================================ -3.00e-01 

FC17 y gust t u -4.32e-01 0.00e+00 <== I I 3.00e-02 

FC18 y gust t 1 2 . 97e-01 0.00e+00 <================================ -3.00e-02 

<12> run 2 


<14> sim 

Enter MATLAB, type ’back’ to leave 

>> specs 

>> prspecs 

>> print 

>> back 

back to SOLVE 

<14> run 2 

<16> sim 

Enter MATLAB, type 9 back ’ to leave 

» back 

back to SOLVE 

<16> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Iter=16 

Ktet 

9 .08983e+00 

1 . 0e+00 

-67. 

07 . 

frozen 

Kphi 

9.55674e+00 

1.0e+00 

37. 

07 . 

frozen 

Kpsi 

7. 35924e+00 

1.0e+00 

07. 

07 . 

frozen 

Kq 

7. 24229e+00 

1 . 0e+00 

27. 

07 . 

frozen 

Kp 

2 . 12648e+00 

1 . 0e+00 

-67. 

07 . 

frozen 

Kr 

4. 52575e+00 

1 . 0e+00 

07. 

07 . 

frozen 

Mtet 

1.32703e+00 

1.0e+00 

07 . 

07 . 


Mphi 

5.98800e+00 

1.0e+00 

-27. 

07 . 


Mpsi 

8 . 13820e-01 

1.0e+00 

-597. 

- 107 . 


Kr_p 

2 . 19954e-01 

1.0e+00 

1657. 

47 . 


Kp_r 

-3 . 82576e-01 

1.0e+00 

207. 

- 47 . 


Kc_y 

-7.57832e-02 

1 . 0e+00 

07 . 

07 . 



<16> pcomb 


Pcomb (Iter= 16) (Phase 3) (MAX_C0ST= -8.40986) 


SPECIFICATION PRESENT 

GOOD 

G 

B 

BAD 

01 p_act_rate -9.82e+01 

0.00e+00 <== 

1 

1 

i.00e+00 

02 r_act_rate -6.42e+01 

0.00e+00 <== 

1 

1 

1.00e+00 
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03 

Cl 

y_act_rate 
stable all 

-8 . 41e+01 
-3 . 22e-02 

0. 00e+00 
0. OOe+OO 

< 

i i 

i i 

1.00e+01 

1.00e-03 

C2 

C3 

pit bw pd 
pit Td 

0 . 00e+00 
-2. 03e-01 

0 . OOe+OO 
0 . OOe+OO 

< 

i i 

2 . 00e-03 
1.00e-04 

C4 

C5 

rol bw pd 
rol Td 

0 . 00e+00 
-2 . 90e-01 

0 . OOe+OO 
0. OOe+OO 

< 

^ — * i 

i i 

2 • 00e-03 
1.00e-04 

Co 

C7 

yaw bw pd 
yaw Td 

0 . UOe+uu 
-3 . 57e-01 

0 . OOe+OO 
0. OOe+OO 
1.00e-07 

< 

i i 

2 * ooe 03 
1.00e-04 
1 . 00e-03 
1.00e-03 
1 . 00e-03 

Co 

pit damp 

0 . OOe+OO 


* s 

C9 

rol damp 

0 . OOe+OO 

0 . OOe+OO 



CIO 

yaw damp 

0 . OOe+OO 

O . OOe+OO 


+ I 

Cll 

pit quickl 

o * loe 02 

0 . OOe+OO 


+ 

-1 . OQe+Qo 

012 

piL qllick2 

2 • ooe-Ul 

O . OOe+OO 


— — 

- l . OQe+uo 

C13 

pit quiokS 

3 • 57 e O 1 

0 . OOe+OO 



-= -1.00e+05 

C14 

rol quickl 

2 » Owfi -1- 0 1 

0. 00e+00 



S === =J -1.00e+05 

C15 

i ol quick2 

o . o3e-01 
1.58e-01 

0 . OOe+OO 


+ 

-1 . OOe+Oo 

C16 

i ol quick3 

0 . OOe+OO 


* ============ 

- 1 . OOe+Oo 

C17 

yaw quickl 

4 . 46e-03 

0. 00e+00 


ststs s 

=== r — : — --- - 1 . 00e+05 

Clo 

yaw quick2 

3 . 9 le-Ul 

0 . OOe+OO 



-1 . OOe+Ob 

C19 

yaw quick3 

5 . 10e-01 

r\A„ 1 AA 

0 . OOe+OO 

r\ i nrv 


*— = ■= = = •= = = =•- 

-1. OOe+Ob 

A AA* AO 

C2Q 

FC1 

yaw dec2 d 
pit dec up 

0 . OOe+OO 
-1 . 40e-01 

0 . OOe+OO 
0. OOe+OO 

a ah 

< = = 

1 1 

2 . 00e~03 
5 .00e-02 

rC2 

FC3 

r* r*A 

pit dec lo 
rol dec up 

2 • OU6 U 1 

-2 . 50e-01 
q cqa- no 

U . uue+uu 
0. 00e+00 

A AAniAA 

<==" 

1 1 

5 . 00e-02 

E. AAn AO 

r C4 

FC5 

FC6 

FC7 

FC8 

FC9 

rol dec lo 
yaw decl u 
yaw decl 1 
p gust p u 
p gust p 1 
p gust t u 

o * ooe U2 
-4 . 26e+00 
4 . 88e+00 
-2 . 21e+00 
4. OOe+OO 
-3 . 92e-01 

o a i a i 

u . uue+uu 
0. 00e+00 
0. OOe+OO 
0 . OOe+OO 
0. OOe+OO 
0 . OOe+OO 

A AAniAA 


1 1 

o . uue uz 
5 . 00e-01 

C AAa A 1 

<== 

1 1 

-o . uue ui 
3 . OOe-Ol 

<==" 

1 1 

3 . 00e-02 

rClU 

FC11 

FC12 

FC13 

FC14 

FC15 

FC16 

FC17 

FC18 

p gust t 1 
r gust p u 
r gust p 1 
r gust t u 
r gust t 1 
y gust p u 
y gust p 1 
y gust t u 
y gust t 1 

z . oie ui 
-1 . 02e+00 
3 . 90e+00 
-4 . 97e-01 
2 . 47e-01 
-3 . 09e+00 
3 . 97e+00 
-4. 30e-01 
3 . 00e-01 

u . uue+uu 
0 . OOe+OO 
0 . OOe+OO 
0 . OOe+OO 
0. OOe+OO 
0 . OOe+OO 
0 . OOe+OO 
0. OOe+OO 
0. OOe+OO 

<==[ 

1 1 

o • uue U 2 
3 . 00e-01 

<=== 

1 1 
1 1 

o . uue u i 
3 . 00e-02 
= -3 . 00e-02 

3 . 00e-01 

<=== 

1 1 

3 . 00e-02 
* -3 . 00e-02 


<16> sim 

Enter MATLAB, type ’back’ to leave 

>> specs 

>> prspecs 

» print 

>> back 

back to SOLVE 

7. Return to the second objective, now that the third is at the boundary 

<16> setgb 0 3 =0 , leOO 
<16> setgb 0 2 =0,10 

7, Return C8 good value to 0 now that the optimization has made it <= 0 

<16> setgb C 8 =0, le-03 
<16> run 0 
<16> pcomb 

Pcomb (Iter= 16) (Phase 3) (MAX_C0ST= -6.42203) 


SPECIFICATION PRESENT 

GOOD 

G 

B 

BAD 

01 p_act_rate -9.82e+01 

0. 00e+00 <== 

1 

1 

1.00e+00 

02 r_act_rate -6.42e+01 

0 . 00e+00 <== 

1 

1 

1.00e+01 

03 y_act_rate -8.41e+01 

0.00e+00 <== 

1 

1 

1.00e+00 


no 



Cl 

stable all 

-3.22e-02 

0.00e+00 <— 

C2 

pit bw pd 

0.00e+00 

0.00e+00 === 

C3 

pit Td 

-2 . 03e-01 

0.00e+00 <— 

C4 

rol bw pd 

0.00e+00 

0.00e+00 ==- 

C5 

rol Td 

-2 . 90e-01 

0.00e+00 <— 

C6 

yaw bw pd 

0.00e+00 

0.00e+00 === 

C7 

yaw Td 

-3 . 57e-01 

0.00e+00 <— 

C8 

pit damp 

0.00e+00 

0.00e+00 === 

C9 

rol damp 

0.00e+00 

0.00e+00 === 

CIO 

yaw damp 

0.00e+00 

0.00e+00 === 

Cll 

pit quickl 

3 . 18e-02 

0.00e+00 

C12 

pit quick2 

2 . 86e-01 

0 . 00e+00 

C13 

pit quick3 

3. 57e-01 

0.00e+00 

C14 

rol quickl 

2 . 86e-01 

0 . 00e+00 

C15 

rol quick2 

6 . 63e-01 

0.00e+00 

C16 

rol quick3 

1 . 58e-01 

0.00e+00 

C17 

yaw quickl 

4.46e-03 

0.00e+00 

C18 

yaw quick2 

3 . 91e-01 

0.00e+00 

C19 

yaw quick3 

5 . 10e-01 

0.00e+00 

C20 

yaw dec2 d 

0.00e+00 

0.00e+00 ===■ 

FC1 

pit dec up 

-1 . 40e-01 

0.00e+00 <== 

FC2 

pit dec lo 

2 . 50e-01 

0.00e+00 <=== 

FC3 

rol dec up 

-2 . 50e-01 

0.00e+00 <== 

FC4 

rol dec lo 

8 .63e-02 

0.00e+00 <=== 

FC5 

yaw decl u 

-4.26e+00 

0.00e+00 <== 

FC6 

yaw decl 1 

4 . 88e+00 

0.00e+00 <=== 

FC7 

p gust p u 

-2 . 21e+00 

0.00e+00 <== 

FC8 

p gust p 1 

4 . 00e+00 

0.00e+00 <=== 

FC9 

p gust t u 

-3 . 92e-01 

0.00e+00 <== 

FC10 

p gust t 1 

2 . 61e-01 

0.00e+00 <=== 

FC11 

r gust p u 

-1 . 02e+00 

0.00e+00 <== 

FC12 

r gust p 1 

3 . 90e+00 

0.00e+00 <=== 

FC13 

r gust t u 

-4 . 97e-01 

0.00e+00 <== 

FC14 

r gust t 1 

2.47e-01 

0.00e+00 <=== 

FC15 

y gust p u 

-3.09e+00 

0.00e+00 <== 

FC16 

y gust p 1 

3 . 97e+00 

0.00e+00 <=== 

FC17 

y gust t u 

-4 . 30e-01 

0.00e+00 <== 

FC18 

y gust t 1 

3 . 00e-01 

0 . 00e+00 <=== 

<16> 

run 2 





1.00e-03 
2 . OOe-03 
1.00e-04 
2 . 00e-03 
1 . 00e-04 
2 . 00e-03 
1 . 00e-04 
1.00e-03 
1 . 00e-03 
1.00e-03 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
2 . 00e-03 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-01 
-5 . 00e-01 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3. 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 


<18> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Iter=18 


Ktet 

9 . 08983e+00 

1.0e+00 


0*/. 

07. 

frozen 


Kphi 

9. 55674e+00 

1.0e+00 


07. 

07. 

frozen 


Kpsi 

7 . 35924e+00 

1 . 0e+00 


07. 

07. 

frozen 


Kq 

7 . 24229e+00 

1.0e+00 


07. 

07. 

frozen 


Kp 

2 . 12648e+00 

1.0e+00 


07. 

07. 

frozen 


Kr 

4.52575e+00 

1.0e+00 


07. 

07. 

frozen 


Mtet 

1 , 32703e+00 

1.0e+00 


07. 

07. 



Mphi 

5 . 98778e+00 

1.0e+00 


07. 

07. 



Mpsi 

8 . 13820e-01 

1 . 0e+00 


07. 

07. 



Kr_p 

2 . 21514e-01 

1 . 0e+00 


07. 

07. 



Kp_r 

-3.83921e-01 

1.0e+00 


07. 

07. 



Kc_y 

-7 . 57832e-02 

1.0e+00 


07. 

07. 



<18> pcomb 







Pcomb (Iter= 18) (Phase 3) (MAX_C0ST= 

-6. 

42418) 



SPECIFICATION PRESENT 

GOOD 



G 

B 

BAD 

01 

p_act_rate -9.82e+01 

0.00e+00 

< = 

= 

1 

1 

1.00e+00 

02 

r.act.rate -6.42e+01 

0.00e+00 

< = 

= 

1 

i 

1.00e+01 

03 

y-.act_rate -8.41e+01 

0.00e+00 

< = 

~ 

1 

i 

1.00e+00 
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Cl 

stable all 

-3 . 21e-02 

0 . 00e+00 

< 

1 1 

1.00e-03 

C2 

pit bw pd 

0 . 00e+00 

0 . 00e+00 


==* 1 

2 . 00e-03 

C3 

pit Td 

-2 . 03e-01 

0.00e+00 

< 

1 1 

1.00e-04 

C4 

rol bw pd 

0.00e+00 

0.00e+00 


==* 1 

2 . 00e-03 

C5 

rol Td 

-2 . 90e-01 

0.00e+00 

< 

1 1 

1.00e-04 

C6 

yaw bw pd 

0.00e+00 

0.00e+00 


==* 1 

2 . 00e-03 

C7 

yaw Td 

-3.57e-01 

0 . 00e+00 

< 

1 1 

1.00e-04 

C8 

pit damp 

0.00e+00 

0.00e+00 


==* 1 

1.00e-03 

C9 

rol damp 

0.00e+00 

0 - 00e+00 


==* 1 

1.00e-03 

CIO 

yaw damp 

0.00e+00 

0 . 00e+00 


==* 1 

1.00e-03 

Cll 

pit quickl 

3 . 22e-02 

0 . 00e+00 


♦ 

=== -1.00e+05 

C12 

pit quick2 

2 . 86e-01 

0 . 00e+00 


* 

-= -1.00e+05 

C13 

pit quick3 

3 . 57e-01 

0 . 00e+00 


* = 

-1.00e+05 

C14 

rol quickl 

2. 86e-01 

0 . 00e+00 


*=_========== 

-==== -1.00e+05 

C15 

rol quick2 

6 . 63e-01 

0.00e+00 


* 

~1 . 00e+05 

C16 

rol quick3 

1 . 59e-01 

0.00e+00 


* 

„„„„ - -1.00e+05 

C17 

yaw quickl 

4 . 44e-03 

0.00e+00 


*_==== =- 

-1.00e+05 

C18 

yaw quick2 

3 . 91e-01 

0 . 00e+00 


*ssssa = =“ 

=========- -1.00e+05 

C19 

yaw quick3 

5 . lOe-Ol 

0.00e+00 


* 

-1 . 00e+05 

C20 

yaw dec2 d 

0.00e+00 

0.00e+00 


==* 1 

2 . 00e-03 

FC1 

pit dec up 

-1.40e-01 

0.00e+00 

< = = 

1 1 

5 . 00e-02 

FC2 

pit dec lo 

2 . 50e-01 

0 . 00e+00 

II 

II 

II 

II 

II 

II 

II 

V 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

~ = -5 . 00e-02 

FC3 

rol dec up 

-2. 50e-01 

0 . 00e+00 

<== 

1 i 

5 . 00e-02 

FC4 

rol dec lo 

8.64e-02 

0 . 00e+00 

II 

II 

II 

II 

II 

II 

II 

V 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

' “ - -5 . 00e-02 

FC5 

yaw decl u 

-4 . 26e+00 

0 . 00e+00 

<== 

1 1 

5 . 00e-01 

FC6 

yaw decl 1 

4 . 88e+00 

0 . 00e+00 

< — ===== 


-5 . 00e-01 

FC7 

p gust p u 

-2 . 21e+00 

0.00e+00 

<== 

1 1 

3 . 00e-01 

FC8 

p gust p 1 

4 . 00e+00 

0.00e+00 



« =-=== -3 . 00e-01 

FC9 

p gust t u 

-3 .92e-01 

0.00e+00 

<== 

1 1 

3 . 00e-02 

FC10 

p gust t 1 

2.61e-01 

0.00e+00 

II 

II 

II 

II 

II 

II 

II 

V 


« = -3 . 00e-02 

FC11 

r gust p u 

-1 . 03e+00 

0.00e+00 

<== 

1 1 

3 . 00e-01 

FC12 

r gust p 1 

3 . 90e+00 

0.00e+00 

c 


*«* - -3 . 00e-01 

FC13 

r gust t u 

-4.97e-01 

0 . 00e+00 

<== 

1 1 

3 . 00e-02 

FC14 

r gust t 1 

2.47e-01 

0.00e+00 

II 

li 

II 

ll 

li 

II 

ll 

V 


: -3.00e-02 

FC15 

y gust p u 

-3 . 09e+00 

0.00e+00 

<== 

1 1 

3 . 00e-01 

FC16 

y gust p 1 

3 . 97e+00 

0.00e+00 

< 


; -3. 00e-01 

FC17 

y gust t u 

-4.30e-01 

0.00e+00 

<== 

1 1 

3. 00e-02 

FC18 

y gust t 1 

2 . 99e-01 

0.00e+00 

II 

II 

II 

II 

II 

II 

II 

V 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

II 

- 3 . 00e-02 


7, Freeze all dp’s but the one you are trying to push to the boundary in 
7, order to help/speed up the optimization. Note slow progress above, 07. 
7. change wrt 0 for all parameters in previous print 


<18> freeze Mtet Mpsi Kr_p Kp_r Kc_y 
<18> print 


Name 

Value 

Variation 

wrt 0 

Prev 

Iter=18 

Ktet 

9 . 08983e+00 

1.0e+00 

oy. 

oy. 

frozen 

Kphi 

9.55674e+00 

1.0e+00 

o y. 

oy. 

frozen 

Kpsi 

7. 35924e+00 

1.0e+00 

oy. 

oy. 

frozen 

Kq 

7. 24229e+00 

1.0e+00 

oy. 

oy. 

frozen 

Kp 

2 . 12648e+00 

1.0e+00 

oy. 

oy. 

frozen 

Kr 

4. 52575e+00 

1.0e+00 

oy. 

oy. 

frozen 

Mtet 

1 . 32703e+00 

1.0e+00 

oy. 

oy. 

frozen 

Mphi 

5 . 98778e+00 

1.0e+00 

oy. 

oy. 


Mpsi 

8 . 13820e-01 

1.0e+00 

oy. 

oy. 

frozen 

Kr_p 

2 . 21514e-01 

1.0e+00 

oy. 

oy. 

frozen 

Kp r 

-3.83921e-01 

1.0e+00 

oy. 

oy. 

frozen 

Kc_y 

-7.57832e-02 

1.0e+00 

oy. 

oy. 

frozen 


<18> run 1 

Segmentation fault (core dumped) 
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7* Console terminated at this point a number of times. In order to 
7. return to the same point, the dp's above were introduced into the 
7. adocs.dp.fin file (’included' in the adocs file) and then adocs was 
7* converted (’convert adocs’) in order to create the adocs. o and adocs. d 
7. files necessary to run solve. Rather than trying to force the roll 
7* channel down to the boundary from above (thereby introducing 
7, segmentation faults as before) , the parameter Mphi was reduced to 
7. bring the roll channel below the level I/level II boundary and thus 
7. the optimization back into phase 2 

archimedes : /sof tware/control/adocs/pjpotter/adocs/solve/Tischler : \ 

? /software/control/adocs/bin/solve -matlab adocs 


Welcome to CONSOL-OPTCAD (TM) 

SOLVE Version 1.7 (Released 8/92) 

Copyright (c) 1991, University of Maryland at College Park. 
All Rights Reserved. 

(developed by Michael K.H. Fan, Andre L. Tits, 

Jian L. Zhou, Li-Sheng Wang and Jam Koninckx) 

[loading/reading adocs. o and ...] 

[reading adocs. d] 

[calling simulator initialization (if any)] 

[connecting to MATLAB engine . . .] 

[including file init.m . . .] 

[calling problem initialization (if any)] 

type "help" for help 

type "help info" for information 


<0> print 


Name 

Ktet 

Kphi 

Kpsi 

Kq 

Kp 

Kr 

Mtet 

Mphi 

Mpsi 

Kr_p 

Kp_r 

Kc_y 


Value 

Variation 

9 . 08983e+00 

1 . 0e+00 

9 . 55674e+00 

1.0e+00 

7 . 35924e+00 

1.0e+00 

7 . 24229e+00 

1.0e+00 

2 . 12648e+00 

1 . 0e+00 

4 . 52575e+00 

1.0e+00 

1 . 32703e+00 

1.0e+00 

5 . 00000e+00 

1.0e+00 

8 . 13820e-01 

1.0e+00 

2.21514e-01 

1.0e+00 

-3 . 83921e-01 

1 . 0e+00 

-7 . 57832e-02 

1.0e+00 


wrt 0 Prev lter=0 


<0> set Mphi = 
<0> setgb Cll : 
<0> setgb C12 
<0> setgb C13 
<0> setgb C14 
<0> setgb C15 
<0> setgb C16 
<0> setgb C17 
<0> setgb C18 
<0> setgb C19 
<0> run 0 
<0> pcomb 


4.5 

0,-1. 00e+05 
0,-1. 00e+05 
0,-1. 00e+05 
=0,-1. 00e+05 
=0,-1.00e+05 
=0,-1.00e+05 
=0,-1 . 00e+05 
=0,-1.00e+05 
=0,-1. 00e+05 


Pcomb (Iter= 0) (Phase 2) (MAX_C0ST_S0FT= 0.550734) 


SPECIFICATION PRESENT GOOD 
01 p_act_rate -9.82e+01 0.00e+00 <= 


G 

I 


BAD 

1.00e+00 
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02 r_act_rate 

03 y_act_rate 

Cl stable all 
C2 pit bw pd 

C3 pit Td 

C4 rol bw pd 

C5 rol Td 

C6 yaw bw pd 

C7 yaw Td 

C8 pit damp 

C9 rol damp 

CIO yaw damp 

Cll pit quickl 
C12 pit quick2 
C13 pit quick3 
C14 rol quickl 
C15 rol quick2 
C16 rol quick3 
C17 yaw quickl 
C18 yaw quick2 
C19 yaw quick3 
C20 yaw dec2 d 
FC1 pit dec up 
FC2 pit dec lo 
FC3 rol dec up 
FC4 rol dec lo 
FC5 yaw decl u 
FC6 yaw decl 1 
FC7 p gust p u 
FC8 p gust p 1 
FC9 p gust t u 
FC10 p gust t 1 
FC11 r gust p u 
FC12 r gust p 1 
FC13 r gust t u 
FC14 r gust t 1 
FC15 y gust p u 
FC16 y gust p 1 
FC17 y gust t u 
FC18 y gust t 1 


-7.49e+01 
-8.41e+01 
-3.21e-02 
0.00e+00 
-2 . 03e-01 
0.00e+00 
-2 . 79e-01 
0.00e+00 
-3 . 57e-01 
0 . 00e+00 
0.00e+00 
0 . 00e+00 
3 . 22e-02 
2 . 86e-01 
3 . 57e-01 
1 . 07e-01 
3 . 27e-01 
-3. 86e-02 
4 . 44e-03 
3. 91e-01 
5 . 10e-01 
0.00e+00 
-1.45e-01 
2.50e-01 
-2.50e-01 
8.64e-02 
-4 . 26e+00 
4 . 88e+00 
-2 . 21e+00 
4 . 00e+00 
-3 . 92e-01 
2 . 61e-01 
-1.03e+00 
3 . 90e+00 
-4 . 97e-01 
2 . 47e-01 
-3.09e+00 
3 . 97e+00 
-4 . 30e-01 
2 . 99e-01 


0.00e+00 <== I 

0.00e+00 <== j 

0.00e+00 <— I 

0.00e+00 ==========* 

0.00e+00 <-- I 

0.00e+00 ==========* 

0.00e+00 <-- I 

0.00e+00 ==========* 

0.00e+00 <— I 

0.00e+00 ==========* 

0.00e+00 ==========* 

0.00e+00 ==========* 

0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0 . 00e+00 
0 . 00e+00 
0.00e+00 ===== 

0.00e+00 <== 

0.00e+00 
0.00e+00 <== 

0. 00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 <== 

0.00e+00 <== 


*====== 

*====== 

*====== 

*====== 

*ss= ==== 

♦====== 

*====== 

♦====== 

*====== 

=* 


0.00e+00 <== 

0 . 00e+00 <========================== 

0.00e+00 <== 

0 . 00e+00 
0.00e+00 
0.00e+00 


<==ssssss: 

<========= 


<================================ 


<================================ 

<======== 

<================================ 

<================================ 


<0> freeze 

Ktet Kphi Kpsi Kq Kp Kr 

Mtet Mpsi Kr_ 

p Kp_r Kc.y 

<0> print 





Name 

Value 

Variation 

wrt 0 Prev 

lter=0 

Ktet 

9 . 08983e+00 

1 . 0e+00 


frozen 

Kphi 

9. 55674e+00 

1.0e+00 


frozen 

Kpsi 

7 . 35924e+00 

1 . 0e+00 


frozen 

Kq 

7 . 24229e+00 

1 . 0e+00 


frozen 

Kp 

2 . 12648e+00 

1.0e+00 


frozen 

Kr 

4. 52575e+00 

1.0e+00 


frozen 

Mtet 

1 . 32703e+00 

1 . 0e+00 


frozen 

Mphi 

4.50000e+00 

1 . 0e+00 



Mpsi 

8 . 13820e-01 

1.0e+00 


frozen 

Kr_p 

2.21514e-01 

1.0e+00 


frozen 

Kp r 

-3 . 83921e-01 

1.0e+00 


frozen 

Kc_y 

-7.57832e-02 

1.0e+00 


frozen 

<0> run 1 





<1> pcomb 





Pcomb (Iter 

= 1) (Phase 2) (MAX_C0ST_S0FT= 0.000109968) 

SPECIFICATION PRESENT 

GOOD 

G 

B 


1.00e+00 
1 . 00e+00 
1.00e-03 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
1 . OOe-03 
1 . OOe-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1 . 00e+05 
2 . 00e-03 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-01 
-5 . 00e-01 
3 . OOe-Ol 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 .00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 


BAD 
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01 p_act_rate 

02 r_act_rate 

03 y_act_rate 

Cl stable all 
C2 pit bw pd 

C3 pit Td 

C4 rol bw pd 

C5 rol Td 

C6 yaw bw pd 

C7 yaw Td 

C8 pit damp 

C9 rol damp 

CIO yaw damp 

Cll pit quickl 
C12 pit quick2 
C13 pit quick3 
C14 rol quickl 
C15 rol quick2 
C16 rol quick3 
C17 yaw quickl 
C18 yaw quick2 
C19 yaw quick3 
C20 yaw dec2 d 
FC1 pit dec up 
FC2 pit dec lo 
FC3 rol dec up 
FC4 rol dec lo 
FC5 yaw decl u 
FC6 yaw decl 1 
FC7 p gust p u 
FC8 p gust p 1 
FC9 p gust t u 
FC10 p gust t 1 
FC11 r gust p u 
FC12 r gust p 1 
FC13 r gust t u 
FC14 r gust t 1 
FC15 y gust p u 
FC16 y gust p 1 
FC17 y gust t u 
FC18 y gust t 1 

<1> run 1 

<2> print 


-9 . 82e+01 
-7 . 28e+01 
-8 . 41e+01 
-3. 21e-02 
0.00e+00 
-2.03e-01 
0.00e+00 
-2 . 81e-01 
0.00e+00 
“3 . 57e-01 
0.00e+00 
0.00e+00 
0 . 00e+00 
3 . 22e-02 
2. 86e-01 
3. 57e-01 
1.59e-01 
3 . 97e-01 
-7 . 70e-06 
4 . 44e-03 
3 . 91e-01 
5 . 10e-01 
0.00e+00 
-1.43e-01 
2 . 50e-01 
-2 . 50e-01 
8 . 64e-02 
-4. 26e+00 
4. 88e+00 
-2. 21e+00 
4.00e+00 
-3 . 92e-01 
2 . 61e-01 
-1 . 03e+00 
3 . 90e+00 
-4.97e-01 
2.47e-01 
-3.09e+00 
3 . 97e+00 
-4.30e-01 
2. 99e-01 


0.00e+00 <== 
0.00e+00 <== 
0.00e+00 <== 
0.00e+00 < — 
0.00e+00 === : 
0.00e+00 <— 
0.00e+00 ==== 
0.00e+00 <— 
0.00e+00 ==== 
0.00e+00 <— 
0.00e+00 === 
0.00e+00 === 
0.00e+00 === 
0.00e+00 
0.00e+00 
0.00e+00 
0 . 00e+00 
0.00e+00 
0 . 00e+00 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 ==== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0 . 00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 
0.00e+00 <== 
0.00e+00 <=== 


I 





Name 

Value 

Variation 

wrt 0 

Prev 

Iter=2 

Ktet 

9.08983e+00 

1.0e+00 

07 . 

07 . 

frozen 

Kphi 

9 . 55674e+00 

1.0e+00 

07 . 

07 . 

frozen 

Kpsi 

7. 35924e+00 

1.0e+00 

07 . 

07 . 

frozen 

Kq 

7. 24229e+00 

1.0e+00 

07 . 

07 . 

frozen 

Kp 

2. 12648e+00 

1.0e+00 

07 . 

0% 

frozen 

Kr 

4. 52575e+00 

1.0e+00 

07 . 

07 . 

frozen 

Mtet 

1 . 32703e+00 

1.0e+00 

07 . 

07 . 

frozen 

Mphi 

4 . 77189e+00 

1 . 0e+00 

67 . 

07 . 


Mpsi 

8 . 13820e-01 

1 . 0e+00 

07 . 

07 . 

frozen 

Kr_p 

2.21514e-01 

1.0e+00 

07 . 

07 . 

frozen 

Kp_r 

-3. 83921e-01 

1.0e+00 

07 . 

07 . 

frozen 

Kc.y 

-7. 57832e-02 

1.0e+00 

07 . 

07 . 

frozen 


<2> pcomb 

Pcomb (Iter= 2) (Phase 2) (MAX_C0ST_S0FT= 3. 13266e-09) 


1.00e+00 
1.00e+00 
1.00e+00 
1.00e-03 
2. 00e-03 
1.00e-04 
2 . OOe-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
1.00e-03 
1.00e-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
2 . 00e-03 
5.00e-02 
-5 . 00e-02 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-01 
-5.00e-01 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3.00e-02 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
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SPECIFICATION 

01 p_act_rate 

02 r_act_rate 

03 y_act_rate 

Cl stable all 
C2 pit bw pd 

C3 pit Td 

C4 rol bw pd 

C5 rol Td 

C6 yaw bw pd 

C7 yaw Td 

C8 pit damp 

C9 rol damp 

CIO yaw damp 

Cll pit quickl 
C12 pit quick2 
C13 pit quick3 
C14 rol quickl 
C15 rol quick2 
C16 rol quick3 
C17 yaw quickl 
C18 yaw quick2 
C19 yaw quick3 
C20 yaw dec2 d 
FC1 pit dec up 
FC2 pit dec lo 
FC3 rol dec up 
FC4 rol dec lo 
FC5 yaw decl u 
FC6 yaw decl 1 
FC7 p gust p u 
FC8 p gust p 1 
FC9 p gust t u 
FC10 p gust t 1 
FC11 r gust p u 
FC12 r gust p 1 
FC13 r gust t u 
FC14 r gust t 1 
FC15 y gust p u 
FC16 y gust p 1 
FC17 y gust t u 
FC18 y gust t 1 


PRESENT 
-9.82e+01 
-7 . 28e+01 
-8.41e+01 
-3.21e-02 
0.00e+00 
-2.03e-01 
O.OOe+OO 
-2.81e-01 
0.00e+00 
-3.57e-01 
O.OOe+OO 
0.00e+00 
0.00e+00 
3 . 22e-02 
2 . 86e-01 
3 . 57e-01 
1 . 59e-01 
3.97e-01 
-2 . 19e-10 
4 . 44e-03 
3 . 91e-01 
5 . 10e-01 
0.00e+00 
-1.43e-01 
2.50e-01 
-2 . 50e-01 
8.64e-02 
-4 . 26e+00 
4.88e+00 
-2 . 21e+00 
4.00e+00 
-3 .92e-01 
2.61e-01 
-1 . 03e+00 
3. 90e+00 
-4 . 97e-01 
2 . 47e-01 
-3 . 09e+00 
3 . 97e+00 
-4 . 30e-01 
2 . 99e-01 


GOOD 

0.00e+00 <== 
0.00e+00 <== 
0.00e+00 <== 
0.00e+00 <— 

G 

1 

1 

1 

1 

O.OOe+OO = 


0.00e+00 <-- 

1 

O.OOe+OO = 

= - * 

O.OOe+OO <— 

1 

O.OOe+OO ===== 

= =* 

O.OOe+OO <— 

1 

O.OOe+OO ===== 

======:* 

O.OOe+OO ===== 

:-====* 


B 

I 


O.OOe+OO ==========* 

O.OOe+OO * 
O.OOe+OO * 
O.OOe+OO * 
0 . 00e+00 * 
O.OOe+OO * 
O.OOe+OO * 
O.OOe+OO * 
O.OOe+OO * 
0.00e+00 * 


O.OOe+OO 
O.OOe+OO 
O.OOe+OO 
O.OOe+OO 
O.OOe+OO 
O.OOe+OO 
O.OOe+OO 
0 . 00e+00 
0.00e+00 
O.OOe+OO 
0 . 00e+00 
O.OOe+OO 
O.OOe+OO 
0.00e+00 
0.00e+00 
0.00e+00 
0.00e+00 


<====== 

<====== 

<====== 

<====== 






<================================ 




0.00e+00 <== I I 

0 . 00e+00 <«===============— ============= 


7. OPTIMAL SOLUTION (note that we did not wait for the C-0 
V, CONGRATULATIONS message) 


BAD 

1.00e+00 
1.00e+00 
1.00e+00 
l.OOe-03 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
2 . 00e-03 
1.00e-04 
1.00e-03 
1.00e-03 
1.00e-03 
-1.00e+05 
-1.00e+05 
-1 . 00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
-1.00e+05 
2 . 00e-03 
5 . 00e-02 
-5 . 00e-02 
5 . 00e-02 
-5 . 00e-02 
5.00e-01 
-5.00e*01 
3 . 00e-01 
-3 . 00e-01 
3 . 00e-02 
-3 . 00e-02 
3 . 00e-01 
-3 .00e-01 
3 . 00e-02 
-3.00e-02 
3 . 00e-01 
-3 . 00e~01 
3 . 00e-02 
-3 . 00e-02 


<2> sim 

Enter MATLAB, type ’back* to leave 
>> specs 
>> prspecs 

>> print nomoptnew.ps 

» back 

back to SOLVE 

<2> store M adocs .dp.nomoptnew" 

<2> quit 

7% The optimal dp*s were stored in adocs . dp.nomoptnew before we quit 
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